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Preface 

In  the  early  1960's,  P..E.  Kalman  presented  his  theories 
on  optimal  filtering  and  control  techniques.  The  advent  of 
the  digitail  computer  has  provided  the  tool  for  implementa- 
tion of  Kalman’s  filtering  theory.  The  recent  trend  toward 
the  use  of  digital  computers  onboard  advanced  aircraft  and 
a more  stringent  requirement  on  navigation  and  weapon  de- 
livery accuracy  has  resulted  in  the  application  of  filtering 
techniques  to  aided  inertial  navigation  systems. 

I spent  many  weeks  in  pursuit  of  a competant  under- 
standing of  Kalman’s  theory  and  several  months  with  the 
CDC-6600  computer  in  order  to  obtain  the  CALCOMP  plots  of 
the  system  state  variable  error  covariances  presented 
throughout  this  report.  The  time  was  well  spent  in  my 
opinion,  but,  I am  sure  there  are  those  in  my  family  who 
might  question  the  premise. 

I would  like  to  express  my  sincere  appreciation  to  Lt. 
Peter  S.  Maybeck,  my  thesis  advisor  as  well  as  my  instructor 
in  the  complexities  of  filtering  theory.  I also  gratefully 
acknowledge  the  assistance  of  Mr,  Richard  M.  Reeves  and  Mr. 
Ed  Hamilton  of  the  Air  Force  Avionics  Laboratory  for  pro- 
viding computer  programs  and  other  docixments  related  to 
this  study  and  for  sharing  their  expertise  and  knowledge 
of  Kalman  filter  design  theory. 


Jerry  E.  Hammett 
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Abstract 

This  report  i ; an  evaluation  of  a proposed  Kalman  fil- 
ter for  an  advanced  manned  aircraft.  The  evaluation  is 
performed  under  simulated  flight  profi?.es  which  include 
straight  and  level  and  maneuvering  flight.  The  aided 
inertial  navigation  system  is  represented  by  a 5^-state 
linear  system  error  model  and  the  filter  by  a 17-state 
error  model  with  decoupled  horizontal  and  vertical  channel 
mechanization.  The  simulated  flight  profiles  include  two 
hours  of  straight  and  level  flight  and  one  additional  hour 
of  either  straight  and  level  or  maneuvering  flight.  A 
comparison  of  filter  effectiveness  with  the  optimal  filter 
is  made  for  the  two  hour  straight  and  level  flight.  The 
decoupled  17-state  filter  effectiveness  is  evaluated  during 
one  additional  hour  of  maneuvering  flight  based  on  the 
filter  performance  in  straight  and  level  flight  for  the 
same  time  period.  In  addition,  an  error  budget  is  deter- 
mined for  both  flight  profiles.  The  decoupled  17-state 
filter  is  found  to  provide  adequate  performance  although 
the  level  channel  velocity  errors  are  twice  those  of  the 
optimal  filter.  No  consistent  conclusions  could  be  drawn 
from  a comparison  of  the  error  budgets  with  the  exception 
that  the  Doppler  induced  error  increased  during  maneuvering 
flight. 
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EVALUATION  OF  A PROPOSED 
INS  KALMAN  FILTER  IN  A 
DYNAMIC  PLIGHT ■ ENVIRONMENT 

I • Introduction 

This  report  is  an  evaluation  of  a Kalman  filter  design 
proposed  for  use  with  navigation  and  weapons  delivery- 
systems  of  advanced  aircraft.  The  evaluation  is  a subprohlem 
of  a current  research  and  development  topic  of  interest  to 
the  Navigation  Division  of  the  Air  Force  Avionics  Laboratory 
at  Wright -Patterson  Air  Force  Base  as  well  as  other  govern- 
ment and  civilian  agencies.  A tentative  reduced  order 
filter  was  designed  previously  to  meet  performance  require- 
ments and  computer  loading  constraints,  but  was  only  eval- 
uated in  a benign  flight  environment.  Thus,  an  evaluation 
of  filter  performance  during  a maneuvering  aircraft  mission 
profile  was  desired.  A CDC-6600  digital  computer  and 
covariance  analysis  techniques  were  used  to  obtain  the 
required  data. 

The  development  of  this  study  is  presented  by  chapters 
in  the  following  sequence.  Preliminary  information  such  as 
reference  frames,  coordinate  transformations,  and  angular 
rates  are  presented  in  the  second  chapter.  Chapter  III  is 
a development  of  the  Kalman  filter  equations  required  to 
solve  the  navigation  problem.  The  fifty-four  state  system 
model  selected  for  the  study  is  presented  in  chapter  IV 
while  the  proposed  filter  design  of  the  decoupled  seventeen 
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state  filter  is  defined  in  chapter  V.  Chapter  VI  delineates 
the  basic  and  dynamic  test  flight  conditions  and  the  error 
budget  determination.  The  results  and  conclusions  comprise 
the  final  chapter  of  this  study. 

Aided-Inertial  System 

The  basic  idea  of  the  aided-inertial  system  is  to  com- 
bine external  navigation  and  attitude  information  (such  as 
position,  velocity,  and  attitude)  received  from  radar, 
doppler,  and  a central  air  data  computer  with  the  inertial 
navigation  system  (INS)  data  to  provide  highly  accurate 
position  and  velocity  information.  Since  the  INS  generally 
presents  accurate  short  term  or  high  frequency  information 
and  the  aiding  systems  generally  provide  more  accurate  long 
term  or  low  frequency  information,  Kalman  filtering  theory 
applies  to  this  combination  of  data  quite  readily  yielding 
a profound  improvement  in  navigation  system  accuracy. 

The  navigation  sensors  considered  in  this  study 
include  an  inertial  measurement  unit  (IMU) , a Doppler  radar, 
a position  fix  radar,  and  a central  air  data  computer  (CADC) 
which  provides  barometric  altitude.  The  basic  IMU  is  con- 
sidered to  be  of  the  type  currently  operational  in  the  Air 
Force  with  navigation  accuracy  of  0.5  nautical  mile  per 
hour.  The  position  fix  radar  is  assumed  to  have  an 
accuracy  of  + 500  feet.  The  Doppler  radar  accuracy  is 
dependent  on  the  aircraft  velocity  with  a relationship  of 
3.^  X 10'^  lV|  where  |V|  is  the  magnitude  of  the  aircraft 
path  velocity  in  feet  per  second.  The  altimeter  is  assumed 
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to  have  an  accuracy  of  +20  feet  (Ref  1.).  An  on-hoard 
computer  is  used  to  apply  the  Kalman  filter  equations • i.e,, 
to  compute  the  Kailman  gains  or  weighting  coefficients,  to 
estimate  the  state  variables,  and  to  apply  the  control  to 
the  INS. 

Kalman  Filter 

The  Kalman  filter  is  an  optimal  recursive  data  processing 
SLlgorithm  located  in  the  on-hoard  computer  or  central 
processor.  The  filter  combines  all  available  measurement 
data,  plus  prior  knowledge  of  the  system  and  measuring 
devices  to  produce  an  estimate  of  the  system  states  in  such 
a manner  as  to  minimize  the  resulting  errors  statistically. 

In  more  easily  understood  terms,  the  filter  provides  the 
best  estimate  possible  subject  to  certain  modeling  assump- 
tions. 

The  filter  will  act  to  optimize  the  attitude,  position, 
and  velocity  information  accuracy  by  weighting  each  data 
source  heavily  in  the  frequency  ranges  where  it  provides 
more  accurate  information,  and  suppressing  it  in  the  region 
where  it  is  less  accurate.  The  inertial  system  provides 
good  high  frequency  information,  but  it  drifts  slowly  and 
therefore  exhibits  poor  low  frequency  performance.  On  the 
other  hand,  the  external  aids  generally  exhibit  good  low 
frequency  information  but  are  subject  to  high  frequency 
noise.  Therefore,  the  filter  will  use  the  good  low  frequency 
external  information  to  damp  out  The  slowly  growing  errors 
in  the  inertial  system. 
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Basic  Assumptions.  The  Kalman  filter  can  be  shown  to 
be  the  best  filter  of  any  possible  fona  based  on  three 
assua^tions.  These  assximptions  are  system  linearity,  white 
noise  drivers,  and  Gaussian  noise  distribution. 

Althoi;^h  the  system  itself  may  be  nonlinear,  forinxila- 
tion  of  an  approximate  linear  error  state  space  model  make 
possible  linear  analysis.  The  justification  for  the  linear 
model  is  based  on  two  points.  In  the  case  of  aided  INS 
systems,  the  use  of  linear  error  state  space  models  has 
proven  to  yield  very  adequate  representations.  The 
techniques  of  linear  systems  analysis  are  well  developed 
and  better  understood  than  those  of  nonlinear  analysis. 

The  white  noise  assumption  implies  that  the  noise  is 
not  correlated  in  time  and  also  has  equal  power  at  all 
frequencies.  If,  in  fact,  a time-correlated  noise  is 
required  to  adequately  model  the  system,  it  can  be  produced 
by  passing  a white  noise  through  a linear  shaping  filter. 
The  system  can  then  be  modeled  with  an  augmented  state 
vector  as  a linear  system  driven  by  white  noise. 

Gaussianess  pertains  to  the  distril ution  of  amplitudes 
of  the  noise  and  implies  that  at  any  single  point  in  time 
the  probability  densivy  function  of  the  amplitude  takes  on 
the  shape  of  a iionaal  bell-shaped  curve.  The  assumption  of 
Gaussian  noise  amplitude  is  justified  by  the  fact  that 
system  or  measurement  noise  is  typically  caused  by  a number 
of  sources.  It  can  be  shown  mathematically  that  when  a 
number  of  independent  random  variables  are  added  the 
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resiiltant  effect  is  very  nearly  a Gavissian  probability 
density  even  though  the  individual  densities  are  not 
Gaussian.  (Ref  2s8-21  and  Ref  9*4-6). 

Under  the  asstoaptions  of  a v/hite  Gaussian  noise,  the 
entire  shape  of  the  density  describing  the  noise  is 
specified  by  its  first  two  moments.  These  three  assumptions 
greatly  simplify  the  mathematics  of  the  problem  and,  in 
fact,  make  them  tractable.  (Ref  2:3-11  and  Ref  3*132)- 

Type  of  Filter  Employed . An  indirect  filter  estimates 
the  errors  in  the  navigation  information  using  the 
difference  between  the  INS  and  external  sensor  data  to 
drive  the  filter.  This  is  in  contrast  to  the  direct  Kalman 
filter  which  uses  the  total  state  space  formulation.  The 
indirect  filter  is  implemented  in  a feedback  configuration 
which  minimizes  the  INS  errors  by  applying  the  weighted 
estimates  as  a control  or  correcting  signal.  (See  Figure  1). 
Since  the  INS  is  corrected  after  each  measurement  sample, 
the  predicted  error  states  and  measurement  differences  at 
the  next  sample  time  will  be  zero.  Therefore,  there  is  no 
need  to  propogate  the  error  state  variable  estimates. 

A discussion  of  the  relative  merits  of  both  feed 
forward  and  feed  back  and  direct  versus  indirect  Kalman 
filter  implementation  is  found  in  Reference  4 pages  1-10. 

It  is  not  the  intent  of  this  study  to  explore  the  develop- 
ment of  Kalman  filter  theory  but  to  evaluate  a proposed 
filter  design.  The  reader  who  is  unfamiliar  with  Kalman 
filter  theory  or  who  seeks  more  detailed  information  is 
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Figure  1.  Indirect  Feedback  Kalman  Filter 


GE/^E/74-45 


referred  to  References  1 through  5 of  the  bibliography. 
Limitations  of  the  Study 

It  is  recognized  that  no  matter  what  system  reference 
model  is  selected,  it  will  only  be  an  approximation  since 
the  complex  real  world  dynamics  are  not  modeled  exactly. 

The  evaluation  of  the  filter  design  is  sensitive  to 
erroneous  reference  system  models  and  statistics?  thus 
great  care  was  used  to  model  the  reference  system  as 
accurately  as  possible  in  the  computer  simulation  in  order 
to  yield  meaningful  results. 

The  system  reference  model  was  provided  by  the  Air 
Force  Avionics  Laboratory  and  contains  fifty-four  error 
state  variables.  This  reference  model  was  used  for  the 
evaluation  in  both  the  "baseline"  or  straight  and  level 
flight  regime  and  the  highly  dynamic  or  maneuvering  flight 
environment . 

Two  flight  profiles  were  chosen  to  simulate  the  air- 
craft environment  during  filter  evaluation.  The  baseline 
data  utilized  a two  hour  (7200  sec)  straight  and  level 
unaccelerated  flight  profile  and  allowed  the  system  errors 
to  reach  approximate  "steady  state"  conditions.  The  second 
flight  profile  simulated  a maneuvering  aircraft  environment 
including  horizontal  and  vertical  accelerations,  turns, 
climbs,  dives,  and  sinusoidal  heading  changes.  This 
dynamic  portion  of  the  flight  had  a duration  of  one  hour 
(3600  sec)  and  utilized  the  baseline  data  at  6300  seconds 
for  steady  state  initial  conditions. 
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An  exceptional  amount  of  time  was  spent  in  interfaciiig 
the  three  computer  programs  req.uired  to  complete  the 
evaluation.  The  computer  resources  required  for  each  data 
run  required  two  to  four  day  tum-around  times  thus  extend- 
ing the  data  collection  time. 
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II.  Coording.te  Systems . Transformation  Matrices,  and 
Angular  Rates 

Coordinate  Frame  Definitions 

Five  different  coordinate  frames  are  defined  to  describe 
the  problem  graphically  and  conveniently.  These  are  the 
inertial  reference  frame,  the  Earth-fixed  frame,  the  navi- 
gation frame,  the  path  frame,  and  the  alpha  wander  frame. 

(See  Figure  2). 

Inertial  Reference  Frame.  The  inertial  coordinate 
system  is  fixed  with  its  origin  at  the  center  of  the  earth 
and  is  nonrotating  with  respect  to  inertial  space.  The 
coordinate  system  thus  defined  is  not  truly  an  inertial 
system,  but  for  the  error  analysis  of  a vehicle  moving  near 
the  earth,  the  errors  introduced  by  this  definition  of 
inertia],  space  are  negligible.  The  axes  of  the  coordinate 
system  form  a right  hand  set  with  the  z-axis  pointing  from 
the  center  of  the  Earth  through  the  North  Pole  in  alignment 
with  the  Earth's  spin  axis  and  the  +x-axis  pointing  to 
Ares  (Ref  6*32) . 

Earth-fixed  Frame.  The  Earth-fixed  reference  frame  is 
identical  to  the  inertial  reference  system  except  that  it 
is  nonrotating  with  respect  to  the  Earth.  The  axes  of  this 
coordinate  system  are  oriented  with  the  z-axis  directed 
outward  through  the  North  Pole,  the  x-axis  directed  through 
the  intersection  of  the  Greenwich  meridian  and  the  equator, 
and  the  y-axis  forms  the  third  member  of  the  right  hand  set. 
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Since  this  frame  is  nonrotating  with  respect  to  the  Earth, 
ant  point  on  the  Earth's  surface  can  be  specified  by  a set 
of  Euler  angle  rotations  in  the  Earth  fixed  frame,  L about 
the  x-axis  (latitude)  and  1 about  the  z-axis  (longitude). 
(Ref  602). 

Navigation  Frame , The  navigation  frame  is  the  frame 
in  which  the  navigation  problem  is  solved.  The  position, 
velocity,  and  attitude  eri'ors  are  expressed  in  navigation 
coordinates.  Since  the  problem  involves  a gimballed  plat- 
form which  remains  essentially  locally  level  at  all  times, 
the  z-axis  of  the  navigation  frame  (Z^)  remains  perpendicu- 
lar to  the  Earth  (positive  upward).  The  x-axis  (X^^)  always 
points  North  and  the  y-axis  (Y^)  points  West  to  complete 
the  right-handed  orthogonal  set  (Ref  6:33). 

It  should  be  noted  that  althought  the  INS  performs 
computations  based  on  an  elliptical  Earth  model,  utilizing 
a rotation  about  the  Earth  centered  x-axis  through  an  Euler 
angle  of  geographic  latitude  (L) , the  Kalman  filter  has 
been  shown  to  provide  reasonable  accuracy  utilizing  a 
spherical  Earth  model  with  Euler  angle  rotation  through 
the  geocentric  latitude  (L  ) . 

Path  Frame . The  path  frame  is  defined  with  its  origin 
at  the  center  of  gravity  of  the  vehicle  and  is  aligned  such 
that  the  x-axis  coincides  with  the  total  vehicle  velocity. 
The  y-axis  is  aligned  with  the  right  wing  of  the  vehicle, 
and  the  z-axis  (h)  forms  the  third  member  of  the  right- 
hand  orthogonal  triad  and  points  down  with  the  aircraft 
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in  level  upright  flight  (Ref  ?i2). 

Alpha  Wander  Frame . The  alpha  vtander  frame  is  defined 
to  be  centered  at  the  navigation  frame  origin.  The  a -axis 
coincides  with  the  z-axis  of  the  navigation  frame  (positive 
upward).  The  x-axis  and  y-axis  are  in  the  plane  of  the 
X and  y axes  of  the  navigation  frame , but  are  rotated  about 
the  z-axis  by  the  angle  alpha.  Alpha  is  defined  as  positive 
when  rotation  is  counterclockwise  as  seen  from  above.  The 
alpha  wander  frame  and  navigation  frame  are  identical  when 
alpha  is  zero. 

Transformation  Matrices 

First , a description  of  the  notation  to  be  used  in  the 
transformation  of  matrices  is  in  order.  The  transformation 
matrices  will  all  be  designated  as  matrices  where  the 

“““al 

transformation  is  from  the  a-reference  frame  to  the 
b-reference  frame.  Thus  is  read  as  "the  transformation 

"3, 

matrix  from  a to  b."  This  matrix  is  a direction  cosine 
matrix  which  transforms  the  components  of  a vector  in  the 
a-reference  frame  to  a corresponding  set  of  components  in 
the  b-refernce  frame  through  from  one  to  several  rotations 
about  primary  axes.  Each  set  of  primar  axes  will  usually 
change  after  a rotation  is  completed. 

The  transformation  matrices  derived  may  be  utilized 
in  various  ways  to  accomplish  the  desired  result.  The 
mathematics  involved  in  these  manipulations  can  be  shown 
to  be  sound  theoretically. 

Typical  examples  of  the  matrices  used  include  such 
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transfo.nnations  as  C^,  which  is  the  transformation  from 
Earth  to  navigation  frame,  C?-  the  transformation  from 
inertial  to  navigation  frame,  and  C^-  the  transformation 
from  navigation  to  the  alpha  wander  coordinate  system. 

These  transformation  matrices  may  he  applied  to 
vectors,  which  may  be  coordinatized  in  any  frame,  as  well 
as  other  matrices.  A typical  example  would  be  to  apply 
to  Vg®  which  gives  the  velocity  of  the  navigation  frame 
with  respect  to  the  Esu-'th  centered  frame  transformed  from 
Earth  to  inertial  frame  coordinates. 

In  order  to  transform  vector  quantities  such  as 
positions  and  velocities  from  one  of  the  above  coordinate 
frames  to  another  it  is  convenient  to  derive  a set  of  time 
varying  transformation  matrices.  These  transformation 
matrices  will  be  used  in  the  development  of  the  simulation 
equations.  To  obtain  the  inverse  transformations  the 
inverse  matrix  is  used  which  is  equal  to  the  transpose 
for  direction  cosine  matrices  and  their  products.  Total 
transformations  from  one  reference  frame  through  a second 
frame  to  a third  reference  frame  are  made  by  multiplying 
the  individual  transformation  matrices  in  the  proper  order. 
The  convention  used  here  is  that  the  transformation  operates 
from  the  subscripted  reference  frame  to  the  superscripted 
frame.  The  proper  multiplication  order  is  such  that  the 
subscripts  and  superscripts  can  be  thought  of  us  a 
cancellation! 

C'l'.-CeCf  (1) 
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Inertial  to  Earth  Transformat i on . The  transformation 
from  the  inertial  reference  frame  to  the  Earth-fixed  frame 
simply  involves  a rotation  of  the  Earth-fixed  axes  about 
the  z-axis  through  an  angle  equal  to  the  Earth  angular 
rate,  which  is  constant,  multiplied  by  the  time  of  rotation 
from  some  arbitrary  time  t=0.  By  projecting  vector 
components  of  the  inertial  frame  along  the  axes  of  the 
Earth-fixed  frame  and  utilizing  the  direction  cosines  in 
the  transformation  matrix  we  obtain 


COS  sinfit  O 

-sinf^t  cosHt  0 

. 0 O 1 
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where  ^-U\q  • the  angular  velocity  of  the  Earth  with 

respect  to  the  inertial  reference  frame. 

Earth  to  Navigation  Frame . The  transformation  from 

the  Earth-fixed  to  navigation  refjrence  frame  involves  two 

rotations.  The  initial  alignment  of  the  navigation  frame 

is  such  that  the  X^-axis  is  coincident  with  the  Z^-axis 

n e 

and  the  Z -axis  is  coincident  with  the  X„-axis.  The 
n e 

rotation  sequence  used  for  the  study  was  to  first  rotate 
about  the  Z -axis  through  an  angle  1 (longitude)  fcliov/ed 

t 

by  a second  rotation  about  the  rotated  Y^-axis  through  an 

n 

angle  L (latitude) , 
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Navigation  to  Path  Frame.  The  derivation  of  the 
transformation  matrix  from  the  navigation  to  the  path 
frame  involves  three  rotations.  The  first  rotation  is 
performed  aoout  the  z-axis  through  the  angle  ijj  (the 
aircraft  heading  ang.\e  measured  clockwise  from  North) 
followed  by  a rotation  about  the  y'-axis  through  the 
angle  Q (the  aircraft  pitch  angle).  The  third  rotation 
is  about  the  x"-axis  through  an  angle  (the  aircraft 
roll  angle).  Seo  Figirre  3.  The  resultant  transformation 
matrix  is  •jhowi-  below.  (Ref  1:121-123  and  Ref  6:3?) 
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Figure  3.  Nav  to  Path  Individual  Coordinate  Transformations 
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Li'iJl  jto  Alpha  Wander  Frame,  The  navigation  to 
alpha  wander  transfoxTuation  matrix  is  obtained  by  a single 
positive  rotation  about  the  z-axis  of  the  navigation  frame 
through  the  wander  angle  alpha  (See  Figure  4} . 
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Figure  4.  Navigation  to  Alpha  Wander  Transformation 
Angular  Rates 

The  angular  rates  are  obtained  and  coordinatized  in  the 
alpha  wander  frame,  since  this  is  the  frame  in  which  the 
computations  will  be  made.  The  values  required  for 
propogation  of  the  Raides  inertial  system  error  model 
(explained  in  chapter  IV)  in  the  alpha  wander  frame  are 
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obtained  from  the  navigat?*on  frame  rates  utilizing  the 
navigation  to  a^.pha  wander  transfoimation.  A flight 
profile  generating  computer  program  which  will  he  dis- 
cussed in  detail  in  Chapter  VI  is  used  to  compute  and 
store  values  related  to  the  dynamics  of  the  aircraft  at 
each  time  increment  of  numerical  integration.  The  profile 
generator  program  was  modified  to  compute  the  required 
velocities  and  accelerations,  as  well  as  other  pertinent 
values,  in  the  alpha  wander  frame.  Note  that  the  air- 
craft's distance  from  the  Earth's  center  is  approximated 
as  being  equal  to  the  radius  of  the  Earth.  This  approx- 
imation is  justified  by  the  fact  that  the  altitude  of  the 
aircraft  is  2000  feet  as  compared  to  an  Earth  radius  of 
approximately  4000  miles  as  well  as  the  fact  that  although 
the  INS  uses  an  elliptical  earth  model  the  Kalman  filter 
can  use  a constant  value  of  R for  earth  radius.  The 
angular  velocity  of  the  Earth  with  respect  to  the  inertial 
frame  coordinatized  in  the  navigation  frame  is 


0 

cosL 

0 

- 

0 

n sin  L 

The  angular  velocity  of  the  navigation  frame  with 
respect  to  the  Earth-fixed  frame  is  obtained  using  the 
stored  values  of  aircraft  velocity  coordinatized  in  the 
navigation  frame.  The  eastward  angular  velocity  is  the 
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time  rate  of  change  of  longitude,  1,  and  the  northward 
angular  velocity  is  the  time  rata  of  change  of  latitude,  L. 
Then 


(7) 

and 

L=v^/r 

(8) 

and 

i = -Vyy/RCOSL 

(9) 

where  e^  and  are  unit  vectors  along  the  axes  about  which 
rotation  occurs  and  R is  the  Earth's  radius.  The  angular 
velocity  of  the  navigation  frame  with  respect  to  the  Earth 
in  navigation  coordinates  becomes 
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angular  accelerations  are  now  obtained  by  taking 
derivatives  of  the  angular  velocities. 
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• n 
Uen 


Px 

Py 

Pz 


(14) 


= '^w/R 

""  ^ ^n/R 


(15) 

(16) 


= f-V\ 
dt 


("Yw  tanUl  = -Aw^QriL-y^Lsec^L  (17) 

^ R / R R 


The  angular  velocity  of  the  navigation  frame  with 
respect  to  the  inertial  frame  expressed  in  navigation 
coojrdinates  is  then 


U/il  = 

~ in  -le  -en 

^^cosL 

1 

Ux 

0 

Vn 

R 

= 

Uy 

(18) 

_ ^^si^L  . 

-y^tanL 

Vz. 

In  order  to  obtain  the  angular  velocities  and  accel- 
erations in  the  alpha  wander  frame  first  premultiply  each 
vector  coordinatized  in  the  navigation  frame  by  the  navi- 
gation to  alpha  wander  transformation  matrix.  Then 


HcosLcosCX 

, .3  ,n 

U-  = u/-  = 

-le  — n-ie 

-ftcosLsinCIX 

sly 

HsinL 

[fizJ 
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= c®  wT 

-en 


(■Vyv/R)cosCX  * {Vtsj/R)sinOC 
^^y\jl^)s\nOC*  {y^lR)cosO(. 
(~Vw/R)tanL 


(20) 


R ) c osO( + ( A R)s  i n Oc 
(A'^/R)sinCX+(A^/R)cosCX 
k"  A\^/  R )tan  L-(Vy^/R)Ls  ec^  L, 


j . 


(\/y^lR)s\nO.^(y^lR)cosOC 

l^^cosCX  -(Vjvj/R)sin(^ 

0 


21) 


(57cosL-Vy^/R)cosCX  (Vfv|/R)sinO( 
^\v'^R-^^co5L)sinO(  *(V^/r)cos(^ 
r25inL-(Vyy/R)tanL 


(22) 


Thus,  "to  get  the  required  angular  velocities  and  accel- 
erations as  measured  in  the  alpha  wander  frame  and 
coordinatized  in  that  frame; 


3 * 

-en 


(23) 


(-Vw/R)cosa  >(V[^/R)sina 

0 

^'Vv^/R)sin(>:  +(VN/R)cosa 

+ 

0 

(24) 

(-Vyy/R)tanL 

,(Vy^/R)tanL 
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which  gives 


,^x  = (”V^/r)cosO^  -*-(Vf^/R)sinOC 
Py  = (Vy^/R)sinCX  +(V|vj/R)cosa 


P.^=  0 


(25) 

(26) 
(27) 


I i 


I 

e- 


for  the  alpha  wander  frame  mechanization. 
Now 


thus. 


(V,sj/R’Av^/R)cosa*(V^/R^A[v^/R)5ina 
^^w/R  ■"  a n/r  )cosO(  “(Vfvj/R  - A^/ R)sinCX 
-(A\^/R)tanL-(Vyy/R)Lsec^L 


O 

0 


L ( A\/\//R  ) to  n L ■*■  ( Vyy /r  ) L s 0 c \\ 


W 


(28) 


-ea 


(V[^/R-A^/R)co5CX  + (Vyy/R+Af^/R)sinO: 
"(V|sg/R-A\/y/R)sinCX  ♦ (V^y/R  + A^/R)cosCX 

0 


(29) 
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Finally 


(S7co5L-Vy^/R)cosO!  +(Vfv^/R)sina 

0 

-(QcosL-Vy^/R)sinCX  ■*-(V^/R)cosCX 

+ 

0 

^^sinL-(V^/R)tanL 

.(Vy^/R)tanL. 

(f^cosL-V^/R)cosO(  +(Vf^/R)sinOC 
-(^lcosL-Vyy/R)sinO:  *(Vfsj/R)cosCX 
QsinL 


(Ref  8tChap  4) 
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III.  Kalman  Filter  Equations 

This  chapter  includes  a discussion  of  the  equations 
required  not  only  for  the  mechanization  of  the  Kalman  filter 
but  also  those  required  to  simulate  the  aircraft  dynamics 
and  driving  error  sources  required  in  the  complete  system 
reference  model.  The  basic  system  model  equations  will  be 
discussed  first  and  the  Kalman  filter  equations  discussed 
for  a given  system  reference  model. 

The  method  of  covariance  analysis  will  be  the  principal 
tool  used  in  solution  of  the  problem.  Physically  derived 
initial  conditions  are  specified  on  the  elements  of  the 
covariance  matrix  JP.  These  conditions  include  both  diagonal 
and  off-diagonal  elements  of  the  matrix.  The  covariance, 
i.e.  variances  of  scalar  variables  and  cross- variances  among 
different  variables,  is  a measure  of  the  uncertainty  in  the 
knowledge  of  true  values  of  the  components  of  the  state 
vector.  In  the  simulation,  both  the  filter  and  system 
covariance  matrices  are  propogated  forward  in  time  using 
numerical  integration  techniques.  When  a specified  update 
time  is  reached,  the  best  estimate  of  the  states  is  deter- 
mined, and  control  is  applied  to  the  system  to  adjust  the 
values  of  the  state  variables.  The  square  root  of  the 
individual  diagonal  elements  of  the  system  covariance 
matrix  (RMS  values)  are  then  plotted  as  a function  of  time 
to  provide  a basis  for  comparison  of  filter  performance. 

For  this  study,  the  plots  are  also  utilized  to  determine 
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the  error  contribution  from  each  modeled  error  source. 

In  the  simulation,  the  error  statistics  are  propogatedj 
i.e.  the  standard  deviation  of  the  noise  value  is  supplied 
when  a noise  is  required.  One  attribute  of  covariance 
analysis  is  that , under  the  assumptions  of  linearity  and 
white  Gaussian  noise,  the  covariance  is  independent  of  the 
actual  measurement  values  and  can  be  computed  without 
generating  a sample  sequence  of  measurements.  Thus  this 
method  is  easier  to  handle  than  a Monte  Carlo  type 
simulation. 

System  Model  Equations 

The  basic  equations  used  are  the  differential  equations 
which  describe  how  the  aided-inertial  navigation  system 
errors  propogate  with  time.  The  equations  are  formulated 
into  a set  of  first  order,  linear  differential  equations, 
driven  by  white  Gaussian  noise.  Linear  measurements  are 
made  upon  the  actual  system  variables,  corrupted  by  white 
Gaussian  noise.  The  equations  representing  a detailed 
model  of  the  system  can  be  formulated  as  follows t 

K = F + Gw  (32) 

where 

Xg  is  an  n^  vector  denoting  the  true  states 
Pg  is  an  nj^  X system  dynamics  matrix 
Gg  is  an  n^^  x m^^  gain  matrix 

w is  an  m.  vector  of  white  noise  inputs  with  zero 
® mean  ana  variance 
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E 


[w(i)w( j)^] 


(33) 


where  i and  j are  instants  in  time.  The  observations 
obtained  from  external  references  can  be  described  by  the 
linear  measurement  vector  equation 


where 


O'*) 


2 is  an  r vector  of  measurements 
■*s 

is  an  r X n.  measurement  matrix 
— s 1 

V is  an  r vector  of  white  noise  inputs  with  zero 
“ mean  and  variance 


s[v(i)v(  j)”^]  = 


S„(i) 

D/- 


i = j 


"0  i y 3 

It  is  assumed  that  the  system  noise  and  measurement  noise 
are  uncorrelated  for  all  time. 


E[w(i)v(j)^]  = 0 for  all  i,j 


(36) 


Filter  Equations 

The  set  of  equations  discussed  above  are  assumed  to  be 
a complete  and  accurate  mathematical  description  of  the 
aided-inertial  system  dynamics  and  measurement  equations 
for  the  purpose  of  simulation.  This  set  of  equations  is 
also  used  to  model  the  full  scale  optimal  Kalman  filter. 

Due  to  the  requirement  to  lessen  the  computational  burden 
on  the  aircraft  computer,  the  suboptimal  filter  equations 
are  obtained  by  reducing  the  dimension  of  the  state  vector. 
The  states  which  are  eliminated  are  those  that  least  affect 
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the  ability  of  the  mathematical  model  to  represent  the  time 
system  dynamics  adequately. 

The  reduced  order  filter  equations  are  then  described  by 


where 


if  “ --f-f  Sf— f 


(37) 


is  an  Hg  vector 

is  an  Hg  X ng  filter  dynamics  matrix 
Gji  is  an  X mg  gain  matrix 

W|.  is  an  mg  vector  of  white  noise  inputs  with  zero 
mean  and  variance 


E[w^(i)w^(  j)^]  = 

The  filter  measurement  equation  is  then 


1 = 0 
i / 0 


(38) 


if  “ Sf  if  '*■  ]£f 


(39) 


where 


Zj,  is  an  r vector 

is  an  r X ng  measurement  matrix 

v«  is  an  r vector  of  white  noise  inputs  with  zero 
mean  and  variance 

E[vj(i)v^(  j)'^j  = fRf(i)  i = j (40) 

L 0 i i 


The  filter  propogation  and  update  equations  based  on  the 
models  above  are  as  given  below.  Between  measurements 
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2f  = 

(41) 

(42) 

starting  from  the  values  of  and  achieved 

most  recent  measurement  incorpcrcttion. 

At  measurement  times 

after  the 

S,  = Bf]-' 

(43) 

Pj  = - KfHfPf 

(44) 

(45) 

where 

is  an  TI2  vector  denoting  the  best  estimate 

is  the  filter  covariance  matrix 

superscript  indicates  the  time  instant  just 
prior  to  update 

+ superscript  indicates  the  time  instant  just 
after  update 

is  the  matrix  of  Kalman  gains 

are  the  actual  values  of  the  measurements  taken 
T 

( ) - is  the  transpose  of  the  matrix  or  vector 
represented  by  the  parenthesis 

The  filter  takes  the  actual  value  of  the  measurements, 
^s,  and  subtracts  from  it  the  best  estimate  of  them  before 
the  actual  measurement  is  taken,  K^x^.  The  difference  is 
then  optimally  weighted  by  the  Kalman  gain  matrix,  K ^ , and 
used  to  correct  x^,  the  best  estimate  of  the  state  prior 
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to  measurement.  This  estimate  is  then  propogated  to  the 

« « 

next  measurement  time  by  the  equations  for  ^ and  P where 
the  process  is  repeated. 

These  recursive  relationships  are  solved  based  on 
initial  conditions  from  an  assumed  Gaussian  density  which 
describe  the  apriori  knowledge  of  the  states. 

i(0)  = (46) 

P(0)  = P (47) 


The  Kalman  filter  propogates  the  conditional  probability 
density  of  the  desired  states,  conditioned  on  the  actual 
measurements  taken.  The  first  and  second  order  statistics; 
i.e.  the  mean  and  variance,  completely  determine  a Gaussian 
density.  Thus,  the  Kalman  filter,  which  propogates  the 
first  and  second  order  statistics,  completely  describes 
the  condition  probability  density  (Ref  10;4-6  and  2:8-21). 

The  expectation  or  mean,  jii  , of  a.  random  variable  is 
defined  as 


eW=« 


.oo 


<oo 


(48) 


which  is  the  weighted  average  of  the  values  of  x,  using  the 
probability  density  function  f(x)  as  the  weighting  function. 
The  mean  is  assumed  to  be  zero  for  all  Gaussian  white 
driving  noises  used  in  the  simulation. 

The  variance,  CiT  , of  a random  variable  X is  defined  as 
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.00 


Var[x]=  ' '* 


-00 


(f-M)  t(|)d/ 


(»9) 


where  (^*~is  the  weighted  average  of  the  values  of  ( X"M)  * 

■'2 

which  makes  0 a measure  of  the  spread  of  the  density 
(Ref  11:136-146).  Thus  O'  is  a direct  measure  of  the 
uncertainty  in  that  the  larger  the  value  of  CT  , the 
hroader  the  probability  density  peak  spreading  the 
probability  'eight  over  a larger  range  of  values  of  X. 

For  a Gaussian  density,  6B.yfo  of  the  probability  weight 
is  concentrated  within  a band  1 Cf  units  to  either  side 
of  the  mean  (/U ) while  95*^  of  the  weight  is  v/ithin  2^^ 
and  99.7^  within  3C^ of  the  mean. 

The  equations  for  the  mean  and  variance  of  X give  the 
first  and  second  order  statistics  for  the  scalar  case. 

These  equations  are  easily  extended  to  the  vector  case, 
as  required  for  this  evaluation,  and  are 


• cx>  ^00 


E[x]=^  = /---j  I d|i  • • ■ d| 

Soo  ' ' ' 


(50) 


.00  ^00 


Cov[x]  ■ /(|-M)(|-M)'’’f(|)df  • - • d|  (51) 

too  coo  ^ 
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IV,  System  Model 

To  apply  the  Kalman  filter  equations  developed,  in  the 
previous  chapter,  a reference  system  model,  which  is  the 
most  complete  linear  model  to  describe  the  real  world,  is 
needed.  This  chapter  outlines  the  reference  system  model 
used  for  the  evaluation.  The  first  section  defines  the  5^ 
error  states  incorporated  in  the  system  model  along  with 
the  assumed  initial  conditions.  The  system  dynamics  matrix, 
F_,  is  presented  in  partioned  form.  The  second  section 
discusses  the  modeling  of  the  plant  INS  error  states. 

Section  three  presents  the  Doppler  radar,  position  fix 
radar  and  barometric  altimeter  error  source  models  as 
linear  systems  driven  by  white  Gaussian  noise.  The  last 
section  describes  the  measurement  equation  (3^)  explicity 
in  matrix  form. 

State  Variable  Definition  and  Initial  Conditions 

Table  I presents  a detailed  listing  of  the  5^  states 
used  in  the  reference  system  model.  The  initial  conditions 
on  the  INS  error  states  have  been  chosen  based  on  values 
used  in  similar  studies.  The  initial  conditions  on  the 
accelerometer  and  gyro  error  states  are  typical  of  an 
inertial  navigation  system  in  the  0.5  nautical  mile  per 
hour  class.  The  initial  conditions  on  the  Doppler  and 
altimeter  system  are  extracted  from  documents  reflecting 
typical  values  for  currently  operational  systems  (Ref  1). 
The  actual  initial  conditions  for  the  position  fix  radar 
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Table  I 

System  54  State  Error  Vector  Definition 


Error  . RMS  Initial 


State 

Symbol 

Definition 

Condition 

INS  Plant  Error  States 

1 

6x 

X position  error 

50,000  ft 

2 

6y 

y position  error 

50,000  ft 

3 

6z 

z position  error 

1,000  ft 

4 

<5Vx 

X velocity  error 

10  ft/sec 

5 

6Vy 

y velocity  error 

10  ft/sec 

6 

(Sv^ 

z velocity  evror 

5 ft/sec 

7 

<50x 

X attitude  error 

.0175  rad 
(1  deg) 

8 

60y 

y attitude  error 

.0175  rad 
U deg) 

9 

<50Z 

z attitude  error 

0.000  rad 

10 

computer  axes  to 
true  axes  compu- 
tation error 

.0349  rad 
(2  deg) 

INS.  Doooler. 

and  Altimeter  Errors 

11 

X gyro  fixed  bias 

.03  deg/hr 

12 

S 

y gyro  fixed  bias 

.03  deg/hr 

13 

z gyro  fixed  bias 

. 045deg/hr 

14 

bz 

z accelerometer 
fixed  bias 

250  }ig 

15 

Doppler  scale  factor  .12?J 

error ; Exponentially 
correlated  T=900  sec 


16 


Doppler  drift  angle  1.8  millirad 

Exponentially 

correlated  T=900  sec 
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System  54  State  Error  Vector  Definition 

(Cont . ) 


Error 

State 

Symtol 

Definition 

RMS  Initial 
Condition 

17 

6h 

Altimeter  error 
Exponent ially 
correlated 
T=  1800  sec 

250  ft 

18 

X gyro  random  bias 
Exponentially 
correlated 
T=  10.800  sec 

.003  deg/hr 

19 

^V2 

y gyro  random  bias 
Exponentially 
correlated 
T=  10,800  sec 

.003  deg/hr 

20 

z gyro  random  bias 
Exponentially 
correlated 
T=  10,800  sec 

.005  deg/hr 

21 

bx 

X accelerometer 
fixed  bias 

25  m 

22 

by 

y accelerometer 
fixed  bias 

25  >»g 

23 

K2 

Doppler  sea  state 
scale  factor  error 

.16  ^ 

24 

62 

Doppler  sea  state 
drift  angle  error 

2.4  millirad 

25 

X 

X 

Q 

X gyro  input  axis 
G sensitivity 

.3  dtg/hr/g 

26 

DXy 

X gyro  spin  axis 
G sensitivity 

.3  deg/hr/g 

27 

nv 

'X 

y Syto  spin  axis 
G sensitivity 

.3  deg/br/g 

28 

DYy 

y gyro  input  axis 
G sensitivity 

.3  deg/hr/g 
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Table  I 

System  54  States  Error  Vector  Definition 

(Cent, ) 


Error 

State 

Symbol 

Definition 

RMS  Initial 
Condition 

29 

DZy 

z gyro  spin  axis 
G sensitivity 

.3  deg/hr/g 

30 

DZz 

z gyro  input  axis 
G sensitivity 

.3  deg/hr/g 

31 

DXxy 

X gyro  spin-input 
2 

G sensitivity 

.04  deg/hr/g 

32 

DYxy 

y gyro  spin-input 
G^  sensitivity 

.04  deg/hr/g 

33 

DZyz 

z gyro  spin-input 
2 

G sensitivity 

.04  deg/hr/g 

34 

GSF^ 

X gyro  scale 
error 

factor 

3 X 10"^ 

35 

GSFy 

y gyro  scale 
error 

factor 

3 X 10'^ 

36 

GSF^ 

z gyro  scale 
error 

factor 

3 X 10'^ 

37 

XGy 

X gyro  input 
misalignment 
the  y axis 

axis 

about 

40  seb 

38 

XG  2 

X gyro  input 
missaignment 
the  z axis 

axis 

about 

40  sec 

39 

YG^ 

y gyro  input 
misalignment 
X axis 

axis 

about 

40 

40 

YG, 

y gyro  input 
misalignment 
the  z axis 

axis 

about 

40 
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Table  1 

System  54  States  Error  Vector  Definition 

(C  ont . ) 


Error 

State 

Symbol 

Definition 

RMS  Initial 
Condition 

41 

ZGx 

2 gyro  input  axis 
misalignment  about 
the  X axis 

40  sec 

42 

ZGy 

z gyro  input  axis 
misalignment  about 
the  y axis 

40  sec 

43 

ASF^ 

X accelerometer 
scale  factor  error 

1.5  X 10'^ 

44 

ASFy 

y accelerometer 
scale  factor  error 

1.5  X 10"^ 

45 

ASF^ 

2 accelerometer 
scale  factor  error 

1.5  X 10"^ 

46 

X 

> 

X accel,  input  axis 
misalign,  about  y 

30  sec 

4? 

X 

> 

N 

X accel.  input  axis 
misalig  u about  z 

180  s^ 

kB 

YAx 

y accel.  input  axis 
misalign,  about  x 

30  sec 

49 

YAz 

y accel.  input  axis 
misalign,  about  s 

180  sec 

50 

2Ax 

2 accel . input  axis 
misalign,  about  x 

30  sec 

51 

ZAy 

2 accel.  input  axis 
misalign,  about  y 

30  sec 

52 

East-West  gravity 
deflection; exp. 
correlated 
T=  d^A  = lOnmA 

26  pg 

53 

<5gn 

North-South  gravity 
deflection; exp . 
correlated 

17  pg 
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Error 

State 


54 


Table  I 

System  54  States  Error  Vector  Definition 

(Cont . ) 


Symbol 

Definition 

RMS  Initial 
Condition 

<5gz 

T=  dyA  = lOnmA 

Gravity  anomaly 
e2g).  correlated 
T=  d^A  60nmA 

a 

35  Jig 
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is  classified}  therefore  numbers  of  a reasonable  order  of 
magnitude  were  selected  to  maintain  the  unclassified  status 
of  the  report.  It  should  be  noted  that  when  an  integrator 
is  required  in  the  simulation  diagram  the  output  of  the 
integrator  becomes  a system  state  variable.  Thus,  the 
addition  of  an  integrator  to  the  error  model  increases  the 
dimension  of  the  error  state  variable  vector  by  one.  The 
X,  y,  and  z axes  for  the  elements  of  the  P matrix  are  alpha 
wander  reference  frame  axes. 

The  value  of  the  elements  of  the  P(0)  matrix  are 


specified  in  Table  I for  each  of  the  reference  system  states 
The  values  actually  used  in  P(0)  are  the  squared  values  of 
the  RMS  initial  conditions  and  these  are  located  along  the 
principal  diagonal  of  the  matrix.  Eighteen  off-diagonal 
elements  enter  into  the  P(0)  matrix  for  airborne  alignment. 


These  are  cross  correlation  terms  between  V and  V and 

X y 

between  the  doppler  bias,  drift,  and  sea  states.  Due  to 

2 2 

symmetry  of  the  P(0)  matrix  (i.e,  ^Vv/Vv^  only  the 

^ y y X 

equation  for  nine  of  the  off-diagonal  elements  are  shown 


below. 


dv^Vy  ='‘^KiKi‘d4K2-d^l(5i-d|2(52’VxQVy^ 


dvxKi  = dK^KiVxo 


-2  -2 

OVxK2  = OK2K2VX0 


GE/EE/74-45 


2 2 
‘^VyKi  = dKiK-,Vyo 

(55) 

2 2 
0'VyK2=  ^K2K2'^yo 

(56) 

= -0-|i6iVyo 

(57) 

*^Vx<§2  ^ '^6262^0 

(58) 

dVy6l  ° 

(59) 

<?Vy62  ' ^26^x0 

(60) 

Propogation  of  the  variance  equation  (42)  requires  additional 

t 

knowledge  of  the  matrices  P and  Q where 

s’  = gqg'^  (61) 

The  Fg  matrix  is  partitioned  as  follows* 


1-10 

11-17 

18-24 

25-42 

43-51 

52-54 

1-10 

^11 

^2 

^13 

^^4 

"15 

NO 

r-4 

11-17 

0 

^22 

0 

0 

0 

0 

18-24 

0 

0 

^33 

0 

0 

0 

(62) 

25-42 

0 

0 

0 

0 

0 

0 

43-51 

0 

0 

0 

0 

0 

0 

52-54 

Q 

0 

0 

0 

0 

^66 
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The  suhinatrices  of  equation  (62)  are  displayed  in 
explicit  form  as  they  are  encountered  in  the  following 

f 

sections.  The  only  non-zero  elements  of  £ are  all 
diagonal  and  are  given  in  the  followir^  sections  as  q^ 
where  the  i subscript  denotes  the  row  and  column  of  the 
element.  For  example,  q^  indicates  that  this  is  the 
element  located  at  the  intersection  of  the  6th  row  and 

I 

6th  column  of  the  ^ matrix  corresponding  to  a white  noise 
input  on  the  6th  state  variable.  There  are  nine  non-zero 

t 

elements  in  the  reference  system  0.  matrix  corresponding 
to  states  15.  16.  1?,  18,  19.  20,  52,  53.  and  54* 
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Plant  Error  States 

The  plant  error  state  equations  are  the  linear 
differential  equations  that  describe  the. natural  unforced 
dynamic  response  of  the  errors  in  the  inertial  navigation 
system.  These  include  ten  states « x,  y,  and  z position, 
velocity  and  attitude  in  the  alpha  wander  frame  and  the 
angular  error  between  the  computer  axes  and  the  true  axes. 
Additional  states  added  to  co.  *)ensate  for  gyro  sensitivity 


39 


GE/EE/74-45 


to  axis  misaligraaent , both  fixed  and  random  bias  errors 
for  gyros  and  accelerometers,  gravity  and  gravity  squared 
terms  which  were  ignored  in  the  basic  plant  equations,  and 
gravity  anomaly  terras.  The  barometric  altimeter  is  added 
to  damp  the  inherently  unstable  vertical  channel  of  the 
inertial  navigation  system.  Doppler  velocity  and  drift 
i angle  are  used  to  provide  external  velocity  data  for 

t 

I inertial  navigation  system  tuning  and  oscillation  damping. 

There  are  various  models  for  the  nine  basic  INS  plant 
states.  The  model  used  by  the  contractor  for  the  plant 
error  states  is  the  RAIDES  inertial  system  error  model 
which  requires  one  more  integrator  than  the  Pinson  error 
model.  A complete  derivation  of  the  Pinson  error  model  is 
given  in  Chapter  4 of  Reference  9 while  a derivation  of  the 
RAIDES  model  is  the  subject  of  Reference  10,  This  model 
comprises  the  matrix  shown  in  Figure  5* 

Error  Source  Models 

The  error  propogation  equations  given  in  Chapter  IV 
were  developed  under  the  assumption  that  the  system 
disturbances,  w(t),  are  not  correlated  in  time.  The 
estimation  of  disturbances  which  have  significant  time 
correlation  is  done  by  means  of  state  ventor  augmentation. 
Thus,  the  dimension  of  the  system  state  vector  is  increased 
by  including  the  correlated  disturbances  as  well  as 
descriptions  of  their  dynamic  response  in  the  appropriate 
rows  of  the  enlarged  F matrix.  Since  these  quantities  are 
random  or  are  unknown  values  (constant  biases)  that  are 


Matrix  (RAIDES  Error  Model) 


GE/EE/74-45 


modeled  as  random  variables » “they  cannot  be  described 
deterministically  and  are  modeled  as  state  variables 
of  a ficticious  linear  dynamic  system  driven  by  white 
noise.  This  model  provides  proper  autocorrelation 
characteristics  through  specification  of  the  linear 
system  and  strength  of  the  driving  noise  while  also 
providing  a random  signal  from  its  random  excitation  (Ref  13). 

The  correlated  noises  in  the  reference  system  model 
are  obtained  from  one  or  more  of  the  basic  errors  models 
described  in  Figure  6.  Specification  of  the  block 
diagram  models  of  these  error  sources  implies  the  structure 

I 

of  the  corresponding  element  of  the  F and  matrices. 

The  random  constant  or  fixed  bias  is  a non-dynamic 
quantity  meant  to  model  a constant  of  unknown  amplitude. 

It  is  simulated  as  the  output  of  an  integrator  with  a 
random  initial  condition  and  no  input.  The  constant 
nature  of  this  model  is  indicated  by  zeros  in  the 

t 

corresponding  row  and  column  of  both  the  F and  Q matrices. 

The  random  wailk  or  varying  bias  gets  its  name  from 
the  illustration  of  a man  who  takes  fixed-length  steps 
in  an  arbitrary  direction.  It  is  modeled  as  an  integrator 
with  a white  noise  input.  In  this  case  the  row  and 
column  of  the  augmented  ^ matrix  contains  a zero  with  a 
non-zero  element,  q,  at  the  intersection  of  the  corresponding 
row  and  column  of  the  ^ matrix. 

The  exponentially  correlated  random  variable,  whose 
autocorrelation  function  is  a decreasing  exponential, 
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Figure  6.  Error  Source  Models  for  Random  Variables 
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provides  a reasonable  approximation  to  a band  limited  signal. 
The  power  spectral  density  ig  approximately  flat  for  a 
finite  bandwidth.  This  model  introduces  a single  non-zero 
element,-^,  into  the  P matrix  where 


= Y 

and  T is  the  correlation  time  constant  of  the  exponentially 
decaying  function.  If  the  corresponding  element  of  the  P(0) 
matrix  is  specified,  then  the  noise  value  required  to  drive 
the  linear  model  is  determined  by  assuming  stationary  stat- 
istics  and  solving  the  P equation  for  steady  state  condi- 
tions.  In  steady  state  P = 0 so  that  the  linear  variance 
equation  becomes 


T 


Q = ff  + Pf 


(65) 


or,  for  the  scalar  case 


0 = -J3p-/3p*q 
q = 2/}p  = 2P/r 


(66) 

(67) 


Therefore,  if  the  initial  covariance  equals  the  steady 
state  (stationary)  value  of  the  variance,  the  exponentially 
correlated  random  variable  requires  a diagonal  element  in 
Q*  whose  value  is  two  times  the  initial  covariance  divided 
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■by  the  correlation  time.  (Ref  50-36  thru  3-J^9). 

Radar  Position  Error  Equations . Assume  and 

represent  the  range  deviations  derived  from 
position  fixing  in  the  north  and  west  coordinate  set.  In 
order  to  use  these  measurements  in  the  Kalman  filter,  the 
computer  first  transforms  them  to  platform  coordinates 
(See  Figure  k) . 


6x' 

.i5y. 

CQsOC  sinCX 


AXn' 

AXy\/ 

(68) 


The  distances  6x  and  6y  in  the  expression  above 
provide  the  actual  position  measurement  error  components 
^ in  the  state  vector  update  equation 


s;  = X-  . HfXf] 


(69) 


The  Hj.x^  portion  of  this  expression  is  the  predicted 
position  measurement  error.  The  difference  between  ^ and 
HfXf  is  called  the  residual.  The  updated  state  error  vector 
Xj  is  used  to  correct  the  navigation  direction  ccsines. 

The  proposed  implementation  makes  corrections  to  the 
direction  cosine  matrix  elements  based  on  the  estimated 
linear  position  errors  ((5Xand(5Y)  in  platform  coordinates. 
The  manner  in  which  the  direction  cosine  matrix  is  updated 
depends  on  whether  the  update  is  derived  from  Doppler 
measurements  or  from  a position  fix.  When  position  fix 
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4rue=^c-^L 


(72) 


The  longitude  error  is  computed  using  the  updated  values  of 
latitude  as 


A1 


ARi 


r cosL 


true 


(73) 


The  longitude  is  updated  to  he 
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The  wander  angle  error  Aot  is  computed  using 


Aot  = 6§2-  AisinLtr-ue 

and  the  wander  angle  corrected  to  be 


(74) 


(75) 


^true  (76) 

It  should  be  noted  that  the  filter  estimate  of  SO 2 > 

the  error  between  computer  axes  and  true  axes,  is  used  in 
the  computation  of  the  wander  angle  correction.  (Ref  12) 

The  updated  values  of  the  latitude,  longitude,  and 
watnder  angle  are  then  used  to  reset  the  Earth  to  wander 
aximuth  direction  cosine  matrix  as  shown  below: 


slsoc-sLclca 

sicd+SLcisa 

cLd 


-sLsica-cisa  | clcoc 
sLshdc-cicoc ; -cLsd 

A A I A 

CLSi  1 SL 


(77) 


where  C = cosine  and  S = sine  of  an  angle. 

Doppler  Error  Equations.  Velocity  updates  require 
more  measurement  processing  than  position  updates.  First 
the  Doppler  velocities  are  expressed  in  platform  wander 
azimuth  coordinates:  nest  the  measured  velocities  are 
differenced  with  computer  or  inertial  navigation  system 
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I i'  velocities}  finally,  for  this  system,  the  velocity  differences 

I ^ are  jacumulated  and  averaged  over  a velocity  update  cycle 

I before  they  are  used  by  the  filter. 

\ The  accumulation  and  averaging  is  performed  for  two 

j reasons.  The  Doppler  output  is  available  each  0.5  seconds 

! (i.e.  a faster  rate  than  required)  and  only  seven  of  the 

t 

t 

twelve  possible  values  are  required  for  computation  of  the 
average  value  of  the  accumulated  velocity  differences. 

‘ The  Doppler  outputs  groundspeed  (V)  and  drift  angle  {/^). 

It  is  stabilized  in  pitch  and  roll  using  IMU  synchro  outputs. 

' The  Doppler  radar  nulls  the  cross  track  velocity  by  rotating 

the  antenna  about  the  z-axis.  Thus  the  Doppler  antenna 
centerline  is  parallel  to  and  aligned  along  the  groundspeed 
' vector.  Doppler  drift  angle  is  proportional  to  cross  wind. 

The  expressions  in  the  airborne  computer  for  resolving 
Doppler  groiindspeed  in  platform  coordinates  are: 


'^Dx  " Vcos(6s'A) 


(78) 


= Vsin(0s-A) 

where  is  the  platform  azimuth  synchro  readout. 

The  difference  between  these  velocities  and  the 
velocities  computed  from  the  IMU  outputs  are: 


(79) 


^c^-Vd; 


(80) 
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AVy  = VCy-  VOy  (81) 

The  differences  are  computed  each  0,5  seconds.  Since  Doppler 
outputs  are  available  at  this  rate,  accumulated,  averaged, 
and  tested  for  reasonableness.  The  average  value  of  the 
accumulated  ve..ocity  differences  is  then  used  in  the  Kalman 
filter  to  update  the  state  error  vector  at  a six  second 
update  rate. 

From  the  discussion  above,  it  can  be  seen  that  the 
measured  velocity  difference  is  of  the  form 


Av 


(82) 


AVynn  = V^y-V^^ 


(83) 


where  the  s’  for  x and  y axes  are  computed  (or  system) 

— p 

velocity  components  in  computer  coordinates  and  the  's 
represent  the  Doppler  velocity  resolved  in  platform 
coordinates. 

The  Doppler  velocity  (Vjj)  is  basically  the  true  velocity 
^Yip)  plus  inherent  or  apparent  (terrain/sea  state)  Doppler 
errors  ( (5V|^  . Let 


V[)  = Vj  + 6Vq 


(84) 


represent  the  Doppler  velocity  in  ideal  platform  coordinates. 
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Then  the  Doppler  velocity  in  actual  (misalignea)  plaxform 
coordinates  is 


(, 


or,  since 

V^  = Vt-0xV^ 


(85) 


(86) 


where  0 is  the  vector  of  platform  misalignment  angles 
(tilts) , then 


For  the  error  dynamics  modeled  in  the  filter,  the 
navigation  system  errors  are  defined  as  the  difference 
between  computed  values  and  true  or  ei'ror-free  values. 
Therefore  vehicle  velocity  error  is  defined  as 


(5  y = V|^  ■ Vj 


In  component  form 


vp  " Vr~".  = (5vv  ~07^v/'"  (5vi-\ 
‘-^x  ^ y Dv 


(88) 


(89) 
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VCy-Vgy=<5Vy*0A-5VDy 

where  the  superscript/suhscript  T has  heen  dropped  from  the 
true  velocity  and  the  superscript  P from  the  Doppler  error 

The  Doppler  error  (5Vq  in  platform  coordinates  is 
derived  from  equations  (?B)  and  (79).  Let  T represent  the 
transformation  angle  T=05'A  from  Doppler  axes  to  platform 
axes.  Let  (5  represent  the  error  in  this  transformation 
caused  by  Doppler  drift  angle  error  and  synchro  readout 
error,  and  let  K represent  Doppler  scale  factor  error. 

The  complete  Doppler  to  platform  axes  transformation 
including  Doppler  and  synchro  errors  becomes 


Vx' 

cos(T-*-(5)  sin(T  + 6) 

y 

■ 

LVyJ 

-siniT+d)  cos(T+6). 

.0. 

(91) 

It  can  be  shown  by  expanding  the  expression  above  that 
the  Doppler  errors  6vd  in  platform  coordinates  are 


1 

y* 


Vx  -Vy' 

‘ K ' 

Vy  v^j 

L(5. 

(92) 


where  K and  0 are  the  Doppler  scale  factor  and  drift  angle 
errors  in  Doppler  coordinates. 

The  Doppler  scale  factor  (K^)  and  drift  angle  (6^^) 
errors  are  modeled  as  exponentially  correlated  random 
variables  generated  by  passing  white  Gaussian  noise  through 
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a first  order  linear  shaping  filter.  The  Doppler  sea  state 
errors  (Kg,  ^2^  modeled  differently  depending  on  the 
aircraft  flight  condition.  Over  land  they  are  modeled  as 
fixed  biases  while  for  flight  over  water  they  are  modeled 
as  exponentially  correlated  random  variables.  The  block 
diagram  for  the  Doppler  error  source  model  is  shown  below. 


Figure  7.  Doppler  Error  Source  Model 

t 

Since  the  Fon  and  submatrices  also  contain  elements 
—22  —22 

determined  by  the  INS  and  altimeter  error  source  models, 
they  will  be  shown  after  the  complete  error  sources  have 
been  discussed. 

INS  Error  Source  Models.  Through  extensive  testing  and 
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and  detailed  knowledge  of  sensor  dynamics  many  imperfections 
and  errors  of  inertial  navigation  systems  are  removed  by 
careful  design.  However,  there  still  remain  errors  whose 
source  defies  compensation.  The  statistical  behavior  of 
these  sensor  errors  can  be  obtained  through  testing  and 
fitting  curves  to  laboratory  experimental  data.  The  error 
models  chosen  for  the  gyros  and  accelerometers  are  typical 
of  an  INS  in  the  one-half  nautical  mile  per  hour  class.  The 
gyro  and  accelerometer  errors  are  modeled  as  a linear 
combination  of  fixed  biases  and  exponentially  correlated 
random  variables  as  shown  in  the  block  diagram,  Figure  8. 
Note  the  coupling  between  the  gyro  error  sources  and  the 
tilt  angles  (0)  of  the  plant  error  source  model  as 
exemplified  in  submatrices  Z12'  -^13'  also 

the  coupling  between  the  accelerometer  error  sources  and 
the  velocities  as  shown  by  submatrices  and  F^^ 

The  eight  gyro  errors  include  long  and  short  term 
drifts  modeled  as  a fixed  bias  and  an  exponentially 
correlated  random  variable  respectively.  Gravity  sensitive 
gyro  errors  in  both  the  spin  axis  and  input  axis  directions 
are  modeled  as  fixed  biases,  as  is  the  spin-input  axes 
gravity  squared  sensitive  error  source.  Gyro  scale  factor 
error  and  input  axis  misalignment  about  the  other  two  axes 
complete  the  list  of  errors  and  are  also  modeled  as  fixed 
biases.  Note  that  each  gyro  adds  eight  states  to  the  state 
error  vector,  requiring  24  additional  states  in  the  system 
state  error  vector  for  the  complete  gyro  error  model. 
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There  are  four  accelerometer  errors  modeled  as  fixed 
"biases.  They  include  accelerometer  bias,  scale  factor  error, 
and  input  axis -misalignment  about  the  other  two  axes.  In 
addition,  gravity  anomaly  is  modeled  as  an  exponentially 
correlated  random  variable.  Since  each  accelerometer  adds 
five  states  to  the  state  error  vector,  an  additional  15 
states  are  required  in  the  system  state  error  vector  for 
the  complete  accelerometer  error  model  (See  Figure  9) • 

I 

The  F and  Q matrix  terms,  recalling  the  definition 

o *^S 

of  states  1 to  5^  from  the  Table  I , are 
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‘^18  ~ 2(1/10,800  sec)  [.003  deg/hr  x 7Trad/l80  deg  x 

1 hr/3600  secj  ^ 

q^g  = 3.9174  X 10*^°  radVsec^ 

‘lie  ^ '^19 

qgQ  = 2(1/10,800  sec)  [.005  deg/hr  x 7T  rad/l80  deg  x 

1 hr/3600  sec]  ^ 
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(105) 


For  the  baseline  data  in  straight  and  level  unaccel- 
erated flight  at  V=710  feet  per  second 


2VP 
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^52 


2(710  ft/sec)  [(26  X 10-^g)  (32.2  ft/sec^-g)1  2 

(10  nm  X 6080  ft/nm)  (107) 
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(1^2  = 1.637  X 10"®  ftVsec^  (108) 

Similarly 

= 2(710  ft/sec)  [(17  x 10’®)  (32.2  ft/sec^-g)]  ^ 

(lOnm  X 6080  ft/nm)  (109) 

q^3  = 6.998  r 10"^  ftVsec^  (110) 

and 

9^4  = 2(710  ft/sec)  [(35  x 10"®g)  (32.2  ft/sec^-g)]  ^ 

(60nm  X 6080  ft/nm)  (ill) 

«l54  = ^*9^  X 10"^  ftVsec^  (112) 

Altimeter  Error  Source  Model.  The  inertial  navigation 
system  vertical  position  is  derived  by  integration  of 
vertical  velocity.  This  output  is  inherently  divergent 
but  is  damped  with  measurements  of  elevation  above  mean 
sea  level  obtained  from  Central  Air  Data  Computer  (CADC) 
output  s . 

The  altitude  is  initialized  either  by  radar  altimeter 
measurement  or  with  altitude  derived  from  the  CADC  using  a 
standard  atmosphere  model.  After  initialization,  CADC 
static  pressure  and  free  air  temperature  are  used  to 
adjust  the  altitude  output  for  non-standard  atmoshperic 
conditions.  Altitude  calibrations  may  be  obtained  when 
the  aircraft  is  over  terrain/sea  of  known  elevation  using 
radar  measurement  techniques.  The  altitude  is  updated 
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every  one  minute  in  this  mechanization. 

The  altimeter  error  is  modeled  as  an  exponentially 
correlated  random  variable.  The  differential  equation  and 
block  diagram  are: 


6h  = *7]  (113) 


Figure  10.  Altimeter  Error  Source  Model 

The  non-standard  atmosphere  algorithm  output  is 
differenced  once  each  minute  with  the  IMU  altitude  output 
to  four  a/i  altitude  observation  for  the  Kalman  filter.  When 
altitude  is  calibrated  the  non-standard  atmosphere  algorithm 
is  reinitialized  to  the  sum  of  the  height  above  terrain 
plus  terrain  height  above  mean  sea  level.  A vertical 
position  update  is  made  within  six  seconds  after  altitude 
calibration. 

I 

The  contributions  made  to  the  system  F and  Q matrices 
from  uhe  gyro  long  and  short  term  drifts,  the  z-axis 
accelerometer  bias,  the  Doppler  scale  factor  and  drift  angle 
errors,  and  the  altimeter  error  are,  again  refering  to 
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Table  I for  the  definition  of  pertinent  state  variable i 


11 

12 

13 

14 

15 

16 
17 


11 

0 

0 

0 

0 

0 

0 

0 


12 

0 

0 

0 

0 

0 

0 

0 


13 

0 

0 

0 

0 

0 

0 

0 


14  15  16  17 

0 0 0 0 

0 0 0 0 

0 0 0 0 

0 0 0 0 

0^00 
0 0^0 
0 0 0-^ 


(114) 


* 2/}^R|5(no.  Of  samples) 

(115) 

qj^^  = 2(1/900  sec)  [.OOI2]  ^(6) 

(116) 

qj^^  = 1.92  X 10"®  /sec 

(117) 

Similarly, 

q.g  = 2(1/900  sec)  [(1.8  x lO"^)  rad] ^(6) 

(118) 

q^^^  = 4.32  X 10"®  rad^/sec 

(119) 

and  q-,y  = 2/?h^17 

(120) 

= 2(1/1800  sec)  [250  ft]  ^ 

(121) 

qj^^  = 69.444  ft^/sec 

(122) 

System  Measurement  Equation 

The  system  measurement  equation  consists  of  a set  of 
five  linear  equations  incorporating  x and  y axis  position 
error,  altitude  error,  and  x and  y velocity  error  and  is 
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I 

f 


{ 
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of  the  form  derived  in  Chapter  III  {Equation  3^). 

The  H matrix  maps  the  state  error  vector  into  predicted 
position,  altitude,  and  velocity  meas\irement  errors.  The 
predicted  errors,  h6x  , are  differenced  with  the  observed 
errors  to  form  the  residuals.  Since  the  position  error 
observation  is  formed  in  platform  coordinates  and  no 
position  measurement  biases  are  estimated  by  the  filter, 
the  position  error  mapping  elements  are  unity.  The  altitude 
observation  is  formed  along  the  z-axis  with  a predicted 
altitude  divergence  of 


(123) 


where  n is  the  filter's  estimate  of  tne  barometric 
altimeter  bias.  The  third  row  of  the  H matrix  therefore 
contains  a one  and  a minus  one  in  the  appropriate  positions 
to  yield  the  above  relation. 

The  rows  of  the  H matrix  that  relate  to  velocity 
measurements  reflect  the  fact  that  the  system  velocity 
error  estimate  must  be  corrected  for  the  Doppler  error 
estimate  in  forming  the  residual  with  the  observed  velocity 
difference.  The  Doppler  error  correction  modeled  in  the  K 
matrix  represents  the  substitution  of  equation  92  into 
equations  89  and  90. 

The  system  measurement  equation  is  equation  3^ 
repeated  here 
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where  the  5^  variables  of  x are  listed  in  Table  I and 

**“S 


6x 

<5y 


(125) 


]ig  is  the  5 "by  5^  matrix  shovm  in  Figure  11.  The  white 
Gaussian  noise  vector  V is  described  by  the  covariance 

“~*S 

matrix  where 


0 0 0 0 

0 CTy  0 0 0 

0 0 cfl  0 0 

0 0 0 0 

0 0 0 0 CT^ 


(126) 


The  values  chosen  for  the  elements  cf  are  shown  in 


Table  II. 
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Figure  11.  System  Measurement  H Matrix 
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Table  II 
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V.  Filter  Design 

This  chapter  discusses  the  filter  design  chosen  for 
mechanization  as  vrell  as  several  preliminary  filters  which 
led  to  this  choice.  None  of  the  preliminary  filter  designs 
are  presented  in  detail  "but  merely  as  outlines  to  show  the 
process  of  filter  reduction.  The  filter  designs  discussed 
include:  (1)  the  54-state  optimal  filter,  (2)  various 
reduced  order  filters,  and  (3)  the  decoupled  17-state  filter. 

Selection  of  the  number  and  type  of  state  variables  to 
be  included  in  the  reduced  order  Kalman  filter  is  based  on 
a trade-off  between  desired  'accuracy  and  computational  time 
required  by  the  onboard  computer,  Obvisously,  the  most 
accurate  filter  would  be  the  optimal  54- state  filter? 
however,  the  burden  this  mechanization  would  place  on  the 
computer  is  unacceptable.  Therefore,  filter  designs  are 
proposed  which  eliminate  second  order  effects  and  weak 
cross-couplings  in  an  attempt  to  reduce  the  dimension  of 
the  error  state  vector  while  maintaining  resonable  filtering 
accuracy.  Many  of  the  stronger  cross-coupling  terms  affect 
filter  performance  only  during  highly  dynamic  flight 
conditions,  while  the  majority  of  time  is  spent  in  relatively 
straight  and  level  unaccelerated  flight.  In  this  case,  it 
is  often  presupposed  that  the  cross-coupling  effects  in 
this  category  may  be  ignored  for  short  periods  of  time  to 
further  reduce  the  complexity  of  the  onboard  computer 
calculations.  This  study  investigates  the  effects  of  a 
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highly  dynamic  flight  regime  on  filter  accuracy  and  attempts 
to  determine  the  major  contributing  error  sources  in  this 
environment . 

The  Optimal  Filter 

The  optimal  filter  system  model  is  simply  an  exact 
replica  of  the  reference  system  model  (i.e.  the  same  5^- 
state  system  and  measurement  model  given  in  Chapter  IV). 

This  optimal  5^-state  filter  will  yield  the  most  accurate 
performance  possible  for  the  given  set  of  reference  system 
error  state  and  measurement  equations.  Thus  the  error 
covariances  obtained  using  the  optimal  filter  are  often 
used  as  the  standard  against  which  to  compare  the  performance 
of  sub-optimal  filter  designs.  This  is  the  technique 
utilized  for  the  initial  portion  of  this  study  (i.e. 
evaluation  of  the  decoupled  17-state  filter  performance  in 
straight  and  level  flight). 

Reduced  Order  Filters 

The  first  attempt  to  design  a sub-optimal  or  reduced 
order  filter  was  made  by  eliminating  the  state  variables 
numbered  25  through  5^  listed  in  the  reference  system  state 
vector  definition  (Table  I)  in  Chapter  IV.  The  result  was 
a 24-state  Kalman  filter  design  with  new  values  for  the 
elements  of  the  g,  matrix.  Elimination  of  the  fixed  biases 
and  exponentially  correlated  random  variables  modeled  in 
reference  system  states  25  through  54  were  compensated  in 
filter  model  by  adding  new  values  or  increasing  existing 
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values  in  the  filter  Q matrix  for  states  1 through  24, 

Next  the  error  state  vector  was  reduced  to  19  states 
by  eliminating  the  short  term  gyro  drifts  and  the  x aixi  y 
axes  accelerometer  bias  terms.  This  mechanization  was 
found  to  be  unsatisfactory  and  the  accelerometer  bias  terms 
were  reinserted  while  the  Doppler  sea  state  variables  were 
combined  with  the  Doppler  scale  factor  and  drift  angle 
errors,  thereby  achieving  a second  19-state  design.  Again 

9 

compensation  was  made  in  the  matrix  by  computing  new 
values  for  appropriate  elements. 

A 17-state  fully  coupled  sub-optimal  filter  design  was 
derived  by  eliminating  the  x and  y axes  accelerometer  bias 
terms  and  decoupling  the  horizontal  (level)  and  vertical 

I 

channels.  The  changes  made  to  the  elements  of  the  ^ 
matrix  to  compensate  for  elimination  of  the  two  level  axis 
accelerometer  bias  terms  will  be  discussed  in  the  section 
on  the  decoupled  17-state  filter. 

Decoupled  17-State  Filter 

The  decoupled  17-state  (13+4)  filter  mechanization 
includes  the  10  states  of  the  Raides  inertial  navigation 
system  error  model,  three  gyro  fixed  biases,  the  z-axis 
accelerometer  bias,  Doppler  scale  factor  and  drift  angle 
errors,  and  the  barometric  altimeter  error  as  the  filter 
error  state  vector  elements.  In  the  navigation  software, 
the  level  axis  (x  and  y)  errors  are  decoupled  from  the 
vertical  axis  (z)  errors.  The  theory  behind  the  decoupled 
equations  will  not  be  discussed  here  but  a thorough 
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treatiaent  may  be  found  in  Reference  14-,  The  elements  of 
17-state  error  vector  are  shown  in  Table  III  along  with 
the  initial  condidtxon  on  each  of  the  error  states. 

The  decoupled  l?-state  filter  mechanization  combines 
state  variables  numbered  3.  6,  l4,  and  1?  into  the  four 
element  vertical  channel  error  state  vector.  The  remaining 
error  state  variables  make  up  the  decoupled  I3  element 
level  channel  error  state  vector.  For  this  evaluation  the 
filter  model  was  treated  as  one  17-state  error  vector  with 
appropriate  cross-coupling  elements  set  to  zero. 

Incorporating  the  Raides  INS  error  model  into  the 
decoupled  17-state  filter  requires  the  computation  of  only 
33  non-zero  terms  in  the  filter  F matrix  as  compared  to  53 
non-zero  terms  required  in  the  fully  coupled  17-state 

plant  error  model.  The  simplified  F matrix  along  with  the 

« 

Q , H,  and  R matrices  for  the  decoupled  17-state  filter  are 
given  in  Equations  127  through  I30  and  Tables  II  and  IV. 

The  submatrices  of  the  filter  F matrix  are  shown  in  Figures 
12  and  I3. 
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Table  III 

Filter  17  State  Error  Vector  Definition 


Error 

State 


Symbol 


Definition 


RMS  Initial 
Condition 


6x 

6y 

6z 

5vx 

6Vy 

6vz 

50  X 


50Z 

6ez 


Plant  Error  States 

X position  error 
y position  error 
z position  error 
X velocity  error 
y velocity  error 
z velocity  error 
X attitude  error 

y attitude  error 

z attitude  error 

computer  axes  to 
true  axes  compu- 
tation error 


50,000  ft 
50,000  ft 
1,000  ft 
10  ft/sec 
10  ft /sec 
5 ft/sec 

.0175  rad 
(1  deg) 

.0175  rad 
U deg) 

0.000  rad 

.0349  rad 
(2  deg) 


,er  and  Altimeter  Errors 


11 

X gi^ro  random 

bias 

.03  deg/hr 

12 

y gyro  random 

bias 

.03  deg/hr 

13 

z gyro  random 

bias 

. 045d eg/hr 

14 

bz 

z accelerometer 
random  bias 

250  pg 

15 

K 

Doppler  Scale 

.15  I0 

factor  error  exp. 
correlated  T = 900sec 
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Table  III 

Filter  12  -State  Error  Vector  Definition 
TCont  .1 


Error 

RMS  Initial 

State 

Symbol 

Definition 

Condition 

16 

6 

6h 

Doppler  drift 
angle  error 
exp.  correlated 
7"  = 900  sec 

6.0  millirad 

17 

altimeter  error 
exp.  correlated 
7”  = 1800  sec 

250  ft 

GE/EE/74-45 


Table  IV 

f 

Decoupled  17-State  Filter  £ Elements 


Element 

Value 

% 

2.7  X 10'^  ft^/sec^ 

^5 

2.7  X 10"^  ftVsec^ 

^7 

2.?6  X 10*^^  radVsec 

% 

2.76  X 10"^^  radVsec 

^11 

1.2  X 10"^^  radVsec^ 

^12 

1.2  X 10”^^  rad^/sec^ 

^13 

1.2  X 10“^^  rad^/sec^ 

^114 

4.15  X 10”^  ftVsec^ 

^15 

3.0  X 10“®  /sec 

4.8  X 10~'^  rad^/sec 

"12 , 

69.44  ft^/sec 

Sf  = 


1-3  4 


Ut  = 
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The  values  of  the  elements  in  the  matrix  are  given  in 
Table  II,  Chapter  IV. 

The  value  of  the  elements  for  the  filter  P(0)  matrix 
are  specified  in  Table  III  for  each  of  the  filter  states. 

The  values  actually  used  are  the  squared  values  of  the  RMS 
initial  conditions  and  are  located'  along  the  principal 
diagonal  of  the  P(0)  matrix.  Tan  off-diagonal  elements 
enter  into  the  filter  P(o)  matrix  for  airborne  alignment  of 
the  INS.  The  relationships  governing  these  initial  conditions 
are  given  in  Equations  (13D  through  (135) « Only  five 
equations  are  given  since  the  off-diagonal  terms  are  identical 
both  above  and  below  the  principal  diagonal  of  the  P(0)  matrix 
(i.e.  cr\Vy  ^ etc.) 


°VxVy 

= (0'kK  - 

(131) 

rf2 

(132) 

^VyK 

' '^kk'^Yo 

(133) 

<6 

= -^66Vyo 

(134) 

If 

< 

X 

c 

(135) 
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VI . Test  Conditions 

The  performance  evaluation  of  the  decoupled  17-state 
filter  was  "based  on  two  test  conditions.  The  first  test 
condition  simulated  a straight  and  level  unaccelerated 
aircraft  flight  profile  of  approximately  two  hours  duration. 
Comparison  of  the  decoupled  17-state  filter  with  the  54- 
state  optimal  filter  utilizes  this  straight  and  level  test 
condition.  The  decoupled  filter  and  reference  system  RMS 
initial  conditions  were  taken  as  the  values  listed  in  Tables 
I and  III  respectively.  The  RMS  initial  conditions  for  the 
optimal  filter  duplicate  those  of  the  reference  system. 

The  second  test  condition  simulated  one  additional 
hour  of  flight.  The  additional  hour  was  obtained  by  insert- 
ing the  final  values  of  all  elements  of  both  the  filter  and 
and  reference  system  P matrices  after  two  hours  of  flight, 
as  obtaiiied  from  the  first  test  condition,  into  the  initial 
P matrices  for  one  hour  of  flight.  The  performance  of  the 
decoupled  17-state  filter  in  straight  and  level  unaccelerated 
flight  under  the  second  test  condition  was  used  as  a baseline 
for  both  the  maneuvering  flight  evaluation  and  error  budget 
determination.  The  second  test  condition  also  included  a 
highly  dynamic  flight  profile  over  the  same  additional  hour 
with  the  initial  conditions  on  the  filter  and  reference 
system^  matrices  described  above.  The  flight  profile  was 
highly  dynamic  to  simulate  aircraft  maneuvers  such  as  might 
be  encountered  during  low  altitude  flight. 

< 
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Basic  Flight  Profile 

The  basic  flight  profile  used  in  this  evaluation  is  a 
straight  and  level  flight  path  at  an  altitude  of  2000  feet 
and  a true  heading  (aircraft  heading  referenced  from  True 
North)  of  30  degrees  with  an  aircraft  velocity  of  710  feet 
per  second.  The  initial  position  chosen  was  45  degrees 
North  latitude  and  60  degrees  West  longitude.  The  course 
flown  was  a rhumb  line;  i.e.  a path  of  constant  heading. 

The  altitude  was  chosen  to  be  compatible  with  a low  altitude 
flight  environment  but  has  little  or  no  effect  on  the 
results  for  a vehicle  operating  near  the  surface  of  the 
Earth  due  to  the  large  value  of  Earth  radius.  The  heading 
of  30  degrees  was  chosen  based  on  preliminary  data  indicating 
that  this  heading  approximates  "worst  case"  conditions  on 
navigation  circular  error  probability.  The  velocity  of  710 
feet  per  second  is  consistent  with  low  altitude  subsonic 
flight  and  converts  to  420  nautical  miles  per  hour  (knots) . 

The  basic  flight  profile  was  generated  by  a subroutine 
in  the  covariance  analysis  computer  program  and  provided 
both  translational  and  rotational  velocity  and  acceleration, 
Earth  radius , and  gravity  data  in  the  alpha  wander  coordinate 
frame.  This  data  was  then  used  during  computation  of  the 
values  to  be  inserted  into  the  elements  of  both  the  filter 
and  the  reference  system  _F  matrices.  The  basic  flight  profile 
is  shown  in  Figure  l4. 

Plots  of  the  RMS  value  of  nine  of  the  ten  plant  error 
states  (position,  velocity,  and  attitude)  error  covariances 
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Figure  14.  Baseline  Flight  Profile 
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for  the  optimal  filter  during  straight  and  level  flight  are 
shovm  in  Figures  15  through  23.  These  plots  provide  the 
basis  against  which  sub-optimal  filter  performance  will  be 
compared.  Note  that  the  time  of  flight  differs  slightly 
between  plots  (7000  seconds  for  the  optimal  filter  and 
7200  seconds  for  the  reduced  filter) . Also , the  vertical 
axis  is  automatically  scaled  in  the  computer  plotting 
routine  and  may  vary  from  one  case  to  the  next  except  for 
the  error  budget  plots.  For  example,  the  optimal  filter 
z axis  attitude  error  (Figure  23)  is  scaled  from  0.0  to 
0.40  X 10”  radians  whereas  the  plot  of  this  same  variable 
for  the  decoupled  17-state  filter  (Figure  32)  is  scaled 
from  0,0  to  0,80  x 10“^  radians.  For  the  error  budget  plots, 
a constant  maximum  value  was  specified  for  the  vertical 
axis  for  each  state  variable  making  all  the  plots  consistent. 

The  reference  system  RMS  position,  velocity,  and 
attitude  error  plots  foi'  the  decoupled  17-state  filter 
during  straight  and  level  flight  are  given  in  Figures  24 
through  32  and  should  be  compared  with  those  for  the  optimal 
filter.  Tables  V and  VI  following  these  plots  compare  the 
reference  system  plant  x,  y,  and  z position,  velocity,  and 
tilt  error  values  for  both  the  optimal  and  decoupled  17- 
state  filter  at  3600  (mid-time  update)  and  63OO  seconds 
(last  recorded  update)  with  the  initial  values  to  provide 
a quick  comparison  of  performance. 

Note  that  the  decoupled  17-state  filter  most  closely 
approaches  the  accuracy  of  the  optimal  filter  after 
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Figure  15*  Optimal  Filter  X 
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Figure  24,  (13+4)  Filter  X RMS  Position  Error 
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Table  V 

Rigs  Errors  of  INS  Plant  States 


Decoupled  17-state  filter  and  optimal  54-state  filter 
performanre  at  3600  seconds  compared  against  initial  values. 
Values  labeled  H are  high  values  and  those  labeled  L are  low 
values  at  the  time  specified. 


Variable 

Initial  Condition 
(units) 

Optimal  Filter 
(t  = 3600  sec) 

Decoupled  17- 
State  Filter 
(t  = 3600  sec) 

(5x 

50,000  ft 

H - 1677.6 
L - 513.7 

H - 1804.3 
L - 51?.  9 

6y 

50,000  ft 

H - I8O9.2 
L - 513.9 

H - 2259.9  I 
L - 519.8 

62 

1,000  ft 

H - 259.2 

L - 259.1 

H - 262.2 

L - 262.2 

6Vx 

10  ft /sec 

H - 2.69 

L - 1.81 

H - 3.51 

L - 2.52 

Ch 

< 

*< 

10  ft/sec 

H - 2.81 

L - 1.97 

H - 3.81  1 

L - 2.67 

6vz 

5 ft/sec 

H - 0.548 

L - 0.546 

H - 0.5^5 

L - 0.563 

60X 

17.5  luillirad 

H - 0.155 

L - 0.153 

H - 0.163 

L - 0.160 

6<^y 

17.5  millirad 

H - 0.171 

L - 0.168 

H - 0.193 

L - 0.192 

o> 

N 

0.0  millirad 

H - 3.32 

L - 3.07 

H - 5.22 

L - 5.27 
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Table  VI 


RMS  Errors  of  INS  Plant  States 


Decoupled  17-state  filter  and  optimal  5^-state  filter 
performance  at  63OO  seconds  compared  against  initial  values. 
Values  labeled  H are  high  values  and  those  labeled  L are  low 
values  at  the  time  specified. 


Decoupled  17- 

Initial  Condition  Optimal  Filter  State  Filter 


<50x 


60y 


(units) 


50,000  ft 


50,000  ft 


1,000  ft 


10  ft/sec 


10  ft/sec 


5 ft/sec 


17.5  millirad 


17.5  millirad 


0.0  millirad 


(t  = 6300  sec)  (t  = 6300  sec) 


H - 1299.6 
L - 487.8 


H - 952.2 
L - 455.0 


H - 256.2 

L - 256.1 


H - 1.59 

L - 1.00 


H - 1.24 

L - 1.04 


H - 0.531 

L - 0.531 


H - 0.149 

L - 0.149 


H - 0.150 
L - 0.150 


H - 1.248 

L - 0.796 


H - 2915.^ 
L - 598.0 


H - 2452.7 
L - 536.7 


H - 260.2 
L - 260.1 


H - 5.00 

L - 2.40 


H - 4.85 

L - 2.75 


H - 0.540 

L - 0.540 


H - 0.169 
L - 0.165 


H - 0.188 

L - 0.186 


H - 6.79 

L - 5.93 


m/m/7^-^5 


approximately  one  hour  and  that  although  aJ.1  the  RJK  values 
continue  to  decrease  from  3^00  to  6300  seconds  for  the 
optimal  filter  this  is  not  true  for  all  the  values  with  the 
decoupled  17-state  filter.  The  effectiveness  of  both  the 
optimal  auid  decoupled  17-state  filter  is  approxiniately  the 
same  in  controlling  x,  y,  and  z position  error  at  36OO 
seconds  I however,  the  effectiveness  of  the  level  channel 
of  the  decoupled  filter  has  decreased  considerably  by  6300 
seconds.  For  example,  the  difference  in  x position  error  at 
3600  seconds  is  only  0.65?6  whereas  it  is  22,6%  at  6300 
seconds.  Also,  the  optimal  filter  has  reduced  the  level 
velocity  errors  to  approximately  10^  of  their  initial 
values  as  compared  to  only  about  26f%  for  the  decoupled  17- 
state  filter  at  6300  seconds.  Both  filters  reduce  the  x 
and  y axis  tilt  errors.  Although  the  z axis  error  increases 
above  the  initial  value  in  both  filters,  the  optimal  filter 
is  much  more  effective  in  controlling  the  increase  than 
the  decoupled  17-state  filter. 

The  effectiveness  of  the  optimal  and  decoupled  17- 
state  filters  in  controlling  Doppler  errors  (not  shown) 
exhibits  similaur  characteristics  to  the  z axis  tilt 
(heading)  error  mentioned  above.  Although  both  filters 
allow  the  Doppler  errors  to  increase  above  the  initial 
values,  the  optimal  filter  is  more  effective  in  controllixig 
this  increase  than  the  sub-optimal  filter  at  6300  seconds 
the  increases  in  OK-j.  and  66-)  , are  65%  and  26% 
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respectively  for  the  optimal  filter  as  compared  to  90.8j5 
and  for  the  decoupled  17-state  filter. 

Both  filter  implementations  essentially  maintain  the 
initial  altimeter  error  although  the  optimal  filter  provides 
a reduction  compared  to  2^  for  the  sub-optimal  filter. 

Plight  Profile  with  Dynamic  Maneuvers 

The  dynamic  flight  profile  used  for  the  evaluation 
consists  of  twenty  separate  flight  path  segments  simulating 
a sinusoidal  heading  change,  rapid  but  shallow  climbs  and 
dives,  heading  changes  intermixed  with  acceleration  and 
deceleration,  another  short  period  of  sinusoidal  heading 
change  followed  by  a climb  and  dive,  and  finally  a short 
period  of  straight  and  level  flight.  The  short  period  of 
straight  and  level  flight  was  included  to  obtain  a measure 
of  the  residual  effects  of  maneuvers  on  filter  performance. 
The  undistrubed  values  of  altitude,  heading,  and  aircraft 
velocity  are  the  same  as  used  in  the  baseline  data  (i.e. 
altitude  = 2000  ft,  heading  = 30°,  veJ.ocity  = 710  ft/sec). 
The  dynamic  flight  profile  has  a total  duration  of  3600 
seconds  and  a breakdown  of  the  actual  dynamics  is  given  in 
Figure  33  and  Table  VII. 

The  dynamic  aircraft  flight  profile  was  simulated  using 
the  PROFGEN  computer  program  described  in  Reference  ?.  The 
rate  of  change  of  aircraft  heading  and  pitch  rate  were 
chosen  as  0.5  degrees  per  second.  Tangential  accelerations 
required  by  the  profile  generator  program  were  computed 


Figure  33.  Dynamic  Plight  Profile 
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Table  VII 

Dynamic  Flight  profile  Data 


Segment 

Time  Duration 
(Seconds) 

Maneuver 

Value 

], 

960 

Sinusoidal 

Heading 

Change 

O.sVsec 
'X'-  160  sec 

2 

20 

Pitch  Up 

+ 2.5° 

3-7 

200 

pitch 

Oscillations 

; 5.0° 

8 

20 

Pitch  Up 
(Level  off) 

+ 2.5° 

9 

40 

Left  Turn 

20^ 

10 

360 

Acceleration 

710  to  760 
ft/sec  T 
(4.3xl0“-^)g 

11 

80 

Right  Turn 

0 

0 

12 

720 

Straight 
and  Level 

0. 

13 

80 

Left  Turn 

40° 

l4 

360 

Deceleration 

760  to  710 
ft/sec  _ 
(4.3x10  ^)g 

15 

40 

Right  Turn 

0 

0 

CM 

16 

320 

Sinusoidal 

Headiiig 

Change 

0.5Vsec 
'f  - 160  sec 

17 

60 

Pitch  Up 

+ 2.5° 

18 

40 

Dive 

- 5.0° 

1 Q 

10 

Pitch  Up 
(Level  off) 

+ 2.5° 

20 

290 

Straight 
and  Level 

0. 
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usirig  coordinated  turn  criteria  for  horizontal  turns  and  a 
maximum  of  0.2  g additional  load  factor  for  vertical 
maneuvers . . 

Plots  of  the  same  nine  plant  error  state  (RMS  values) 
shovm  previously  are  given  in  Figures  34  through  42  for  the 
decoupled  17-state  filter  during  the  additional  one  hour  of 
straight  and  level  flight.  As  stated  previously,  these  plots 
are  the  basis  for  the  dynamic  flight  profile  performance 
evaluation.  Note  the  horizontal  portion  of  the  curve  which 
represents  the  initial  condition  value  as  if  it  were  constant 
for  the  first  two  hours  of  flight.  The  data  for  the  add- 
itional hour  of  flight  is  displayed  between  7200  seconds 
and  10800  seconds.  This  data  can  be  considered  as  simply 
a continuation  of  the  error  plots  shown  in  Figures  24  through 
32.  Note,  however,  the  vertical  scale  has  been  reduced  to 
depict  the  error  plots  in  greater  detail.  Also  note  that 
the  minimum  value  on  the  ordinate  axis  is  not  always  zero. 

Although  the  curves  seem  to  Indicate  a sudden  increase 
in  the  error  for  all  nine  error  states  at  t=7200  seconds, 
this  is  not  the  case.  The  initial  conditions  put  into  the 
P matrix  for  the  additional  hour  of  flight  were  values 
obtained  just  after  the  update  at  7200  seconds  and,  in  fact, 
represent  a "low"  point  on  the  error  curves.  Therefore,  it 
is  reasonable  to  expect  the  error  to  grow  prior  to  the  next 
update  as  shown  by  the  curves. 

It  is  of  interest  to  note  from  Figures  34  through  42 
that  the  greatest  reduction  of  errors  occurs  at  position 
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Figure  39.  Decoupled  Filter  Baseline  Z RWS  Velocity  Error 
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update  time  for  all  variables  except  z RMS  position  and 
velocity  errors.  It  seems  therefore,  that  although  velocity 
updates  occur  every  six  seconds  and  altimeter  upaates  every 
60  seconds,  the  position  update  rate  or  availability  has  the 
primary  effect  on  reducing  errors  to  acceptable  values. 

Table  VIII  compares  the  x,  y,  and  z position,  velocity, 
and  tilt  errors  during  the  additional  hour  of  straight  and 
level  flight  with  the  initial  values.  By  comparison  with 
the  data  of  Table  VI,  it  can  be  seen  that,  with  the  exception 
of  Y RMS  position  and  velocity  error,  all  errors  have  been 
further  reduced.  The  increase  in  Y RJC  position  and 
velocity  error  can  be  seen  by  comparing  average  values  for 
both  variables.  The  average  values  of  Y position  and 
velocity  error  from  Table  VI  are  1^9^. 7 feet  and  3*24  feet 
per  second  respectively.  The  average  values  obtained  from 
Table  VIII  are  1780.95  feet  and  3* ^^5  feet  per  second 
respectively.  Thus  the  increase  in  Y RMS  position  error 
is  286.25  feet  and  the  increase  in  Y RMS  velocity  error  is 
0.205  feet  per  second.  This  apparent  increase  can  be  shown 
to  be  due  to  a maiximum  value  in  the  periodic  oscillation 
of  the  errors  about  a steady  state  average  value  at  a 
frequency  which  corresponds  to  the  Schuler  period  of  84 
minutes.  In  fact,  X RMS  position  and  velocity  errors  also 
exhibit  this  oscillation,  but  have  reached  a minimum  value 
at  time  = 10,020  seconds.  This  periodic  oscillation  is 
readily  shown  on  the  x and  y position  and  velocity  error 
curves  in  Figures  24,  25,  27,  and  28. 


GE/EE/?4-i|-5 


Table  VIII 

Straight  and  Level  RMS  Errors  ^ INS  Plant  States 

Decoupled  17-state  filter  performance  compared  against 
initial  values.  Values  labeled  H are  high  values  and  those 
labeled  L are  low  values  at  the  time  specified.  Initial 
values  input  the  J matrix  are  L values. 


Variable  : 
(units) 

Initial  Condition 
(t=7200  sec) 

liSSSSEBil 

6x 

ft 

H - 2616.3 
L - 574.6 

H - 778.2 

L - 743.1 

6y 

ft 

H - 2404.7 
L - 53V . 0 

H - 1376.8 
L - 1214.1 

(5z 

ft 

H - 259.4 

L - 259.4 

H - 117.0 

L - 116.1 

ft/sec 

H - 4.36 

L - 2.09 

H - 0.498 

L - 0.382 

6Vy 

ft/s'ec 

H - 4.46 

L - 2.45 

H - 3.41 

L - 3.25 

6vz 

ft/sec 

H - 0.537 
L - 0.537 

H - 0.359 
L - 0.359 

6(t>x 

millirad 

H - 0.168 

L - 0.165 

1 

H - O.I83 

L - O.I83 

60  y 
millirad 

H - 0.182 

L - 0.180 

H-  0.138 

L - 0.137 

602 

millirad 

H - 6.45 

L - 5.61 

H - 5.61 

L - 5.57 

870.3 

475.4 


2987.2 

574.7 


109.0 

108.9 


0.947 

0.838 


4.60 

2.29 


0.359 

0.358 


0.166 

0.164 


0.155 

0.154 


5.67 

4.96 
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Plots  of  the  X,  y,  and  z position,  velocity,  and  tilt 
errors  for  the  decoupled  17-state  filter  in  maneuvering 
flight  are  shown  in  Figures  4-3  through  51*  Note  the  increase 
in  the  x position  and  velocity  and  y tilt  errors.  Also  note 
the  decrease  in  the  y position  and  velocity  and  the  x tilt 
errors.  The  z axis  errors  remain  unchanged  except  for  a 
decrease  in  the  z tilt  (heading)  error.  As  during  straight 
and  level  flight , the  position  updates  have  the  greatest 
effect  in  reduciiig  the  magnitude  of  the  errors.  The  sinusoid- 
al headir.g  change  during  the  initial  portion  of  the  maneuv- 
ering flig)vfc  profile  has  xhe  greatest  effect  on  x and  y 
velocity  errors.  However,  after  three  position  updates,  the 
sinusoidal  heading  change  later  in  the  profile  seems  to  have 
negligible  effect.  Slow  turns  and  path  accelerations  iiicreased 
the  X position  and  velocity  errors,  and  although  these  errors 
decreased  during  the  720  second  period  of  straight  and  level 
flight  midway  through  the  profile,  the  average  values  are 
approximately  l|-  times  those  reached  during  straight  and  level 
flight  for  the  entire  hour.  Although  y velocity  error 
decreases  slightly,  the  magnitude  of  this  change  is  small 
compared  to  the  increase  in  x velocity  error.  Table  IX 
compares  the  x,  y,  and  s position,  velocity,  and  tilt  errors 
during  the  additional  hour  of  maneuvering  flight  with  the 
initial  values.  The  changes  in  magnitude  of  the  errors  can  be 
seen  by  comparing  Tables  VIII  and  IX.  This  comparison  is 
shovm  in  Table  X.  The  values  given  in  Table  X are  *' average" 
values  and  ars  obtained  by  adding  the  RMS  error  value  of  a 
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Table  IX 

Maneuvering  RMS  Errors  of  INS  Plano  States 

Decoupled  17-state  filter  performance  compared  against 
initial  values.  Values  labeled  H are  high  values  and  those 
labeled  L are  low  values  at  the  time  specified.  Initial 
values  input  in  the  X matrix  are  L values. 


1 

2 
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Talkie  X 

Comt?arison  of  Decoupled  17-State  Filter  Average  RMS  Errors 

Decoupled  17-state  filter  performance  for  straight  and 
level  versus  maneuvering  flight  profiles.  Average  values  are 
obtained  from  Tables  VIII  and  IX  by  adding  the  high  and  low 
values  and  dividing  by  two.  Flight  profiles  are  straight  and 
level  (S-L)  and  maneuvering  (M) . 


Flight  Time 


Variable 

(units) 


(5x 

ft 

(5y 

ft 


ft/Yib 


irad 


60  y 

millirid 


60Z 

mi 111 rad 


8640  sec 


10,020  sec 


Flight  Profile 

Flight 

Profile 

S-L 

M 

S-L 

M 

760.65 

1130.05 

672.85 

993.80 

1295.45 

1186.45 

1780.95 

1048.70 

1 

116.55 

94.35 

108.95 

103.10 

0.44 

2.73 

0.89 

2.27 

3.33 

3.45 

2.69 

0.3590 

ma 

0.3585 

0.3525 

0.183 

0.159 

0.165 

0.156 

0.138 

0.158 

0.155 

0.167 

5.59 

4.89 

5.32 

4.04 
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variable  at  the  time  instant  before  the  data  sample  time  to 
its  value  just  after  the  data  sample  time  and  dividing  by  two. 

Error  Budget  Determination 

The  error  budget  determination  was  made  using  five 
separate  computer  runs  during  both  straight  and  level  and 
maneuvering  flight.  The  nine  basic  INS  plant  error  state 
errors  were  plotted  and  then  superimposed  to  obtain  the  data. 
The  system  reference  model  was  altered  for  each  computer  run 
by  adding  the  appropriate  models  for  gyro,  accelerometer, 
Doppler,  and  altimeter  errors  progressively  to  the  basic 
INS  plant  error  model.  Thus  five  curves  appear  on  each 
figure  showing  the  error  contribution  from  each  source  added 
to  the  previous  curve.  The  first  curve  depicts  the  error 
contributed  by  the  basic  INS  decoupled  plant  model.  The 
P(0),  and matrix  elements  not  associated  with  these  first 
ten  states  (see  Table  I)  are  all  set  to  zero.  Since  no 
conclusive  data  was  available  to  determine  the  separate 
measurement  noise  contribution  from  the  INS,  radar,  altimeter, 
Doppler,  etc.  , all  elements  of  the  R matrix  were  assumed  to 
correspond  to  variables  in  the  basic  INS  plant  model  and 
their  values  are  included  at  this  point.  The  second  curve 
gives  a plot  of  the  errors  after  including  the  gyre  modeling 
terms  and  the  associated  values  in  the  matrix.  Next  the 
accelerometer  model  and  associated  Q elements  were  added. 

The  fourth  cur'/e  includes  the  effect  of  the  Doppler  while 

the  last  curve  adds  the  altimeter  model  and  noise  to  complete 
the  system  reference  model.  The  plots  for  straight  and  level 
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I 

i flight  are  shovm  in  Figures  52  through  60  while  the  error 

i i 

\ j budget  for  maneuvering  flight  is  given  in  Figures  61  through 

i 69. 

As  can  be  seen  from  the  plots,  the  propogation  of  the 
initial  conditions  through  the  plant  model  alone  contributes 
; most  of  the  error  for  the  position  and  x velocity  curves 

i 

but  exhibits  the  minimum  error  for  z velocity.  Note  that  z 
I position  and  velocity  errors  as  well  as  x,  y,  and  z attitude 

(tilt)  errors  are  a minimtim  for  the  plant  model  alone.  The 
addition  of  the  gyro  and  accelerometer  models  increases  the 
i tilt  errors  but  decreases  the  x-  y,  and  z position  and 

velocity  errors.  The  Doppler  appears  to  reduce  x and  y 
position  and  velocity  errors  with  little  effect  on  z position 
and  velocity  or  on  tilt  errors.  This  data  is  suspect  in  that 
the  change  from  an  error  free  Doppler  to  a noise  corrupted 
Doppler  model  should  not  cause  a decrease  in  the  Doppler 
error  contribution.  As  more  error  sources  are  added  to  the 
model,  the  volume  of  the  error  ellipsoid  (i.e.,  the  eigen- 
values of  the  covariance  matrix)  must  not  decrease . A 
possible  explanation  of  this  phenomenon  is  that  some  off- 
diagonal  terms  may  have  increased  unobserved  while  the 
individual  RMS  values  (diagonal  term  square  roots)  decreased. 
This  would  allow  the  volume  of  the  error  ellipsoid  to  in- 
crease although  the  RMS  values  indicate  it  is  decreasing. 
Addition  of  the  altimeter  has  a greater  effect  on  z position 
and  velocity  than  on  any  of  the  other  variables. 

Tables  XI  through  XX  show  the  high  and  low  values  of 
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Figure  56.  Straight  and  Level  Y RMS  Velocity  Error  Budget 
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Figure  6j.  Maneuvering  Z RMS  Position  Error  Budget 
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Figure  64,  Maneuvering  X RMS  Velocity  Error  Budget 
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Table  XI 

Plant  Error  States  Straight  and  Level  RMS  Errors 


Values  labeled  H are  high  values  and  values  labeled  L 
are  low  values  at  data  time.  Initial  condition  values  are 
taken  from  the  total  reference  system  model. 


Variable 

Initial  Condition 

Decoupled  17 

’-State  Filter 

(units) 

(t=7200  sec) 

HS&BShES3BII 

6x 

H - 

2616.3 

H 

- 

1152.5 

H - 

1185. 4 

ft 

L - 

57^.6 

L 

- 

1054.9 

L - 

500.1 

6y 

H - 

2404.7 

H 

- 

1968.8 

H - 

3528.5 

ft 

L - 

537.0 

L 

- 

1712.6 

L - 

6O8.4 

6z 

H - 

259.4 

H 

- 

272.7 

H - 

178.0 

ft 

1 - 

259.4 

L 

- 

268.2 

L - 

171.7 

6vx 

H - 

4.36 

H 

- 

2.00 

H - 

1.75 

ft/sec 

L - 

2.09 

L 

- 

2.00 

L - 

1.30 

dVy 

H - 

4.46 

H 

- 

H - 

4.02 

ft/sec 

L - 

2.45 

B 

B 

L - 

1.82  1 

H - 

0.537 

H 

- 

0.553 

H - 

■■■  ■ — - 1 

0.013 

ft/sec 

L - 

0.537 

L 

- 

0.458 

L - 

0.020 

<50x 

H - 

0.168 

H 

- 

C.130 

H - 

0.085 

millirad 

L - 

0,165 

L 

- 

0.127 

L - 

0.083 

60y 

H - 

0.182 

H 

- 

0.048 

H - 

0.055 

millirad 

L - 

0.180 

L 

— 

0.048 

L - 

0.054 

j 50Z 

H - 

6.45 

H 

- 

4.44 

H - 

3.38 

jmillirad 

L - 

5.61 

L 

- 

4.43 

L - 

2.69 
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Table  XII 

Plant  + Gyro  Error  States  Straight  and  Level  RMS  Errors 

Values  labeled  H are  high  values  and  values  labeled  L 
are  low  values  at  data  time.  Initial  condition  values  are 
taken  from  the  total  reference  system  model. 


6vx 

ft /sec 


6Vy 

ft/sec 


6^2 

ft/sec 


60X 

millirad 


60y 

millirad 


60; 


millirad 


Initial  Condition 
(t=7200  sec) 


H - 2404.7 
L - 537.0 


Decounled  17-State  Filter 


259.4 

259.4 


4.36 

2.09 


4.46 

2.45 


0.537 

0.537 


0.168 

0.165 


0.182 

0.180 


6.45 

5.61 


H - 

958.8 

H 

- 

788.3 

L - 

894.6 

L 

- 

478.0 

H - 

1751.7 

H 

- 

3122.9 

L - 

1542.3 

L 

- 

590.2 

H - 

379.2 

H 

- 

32.1 

L - 

372.8 

L 

- 

32.1 

H - 

1.32 

H 

- 

1.34 

L - 

1.25 

L 

- 

1.30 

H - 

4.02 

H 

- 

4.89 

L - 

4,15 

L 

- 

2.51 

H - 

0.096 

H 

- 

0.101 

L - 

0.095 

L 

- 

0.097 

H - 

0.112 

H 

- 

0.095 

L - 

0.111 

L 

- 

0.090 

H - 

0.0027 

H 

- 

0.063 

L - 

0.0096 

L 

- 

0.063 

H - 

5.58 

H 

- 

5.76 

L - 

5.62 

L 

- 

5.03 
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Table  XIII 

Plant  + Gyro  + Accelerometer  Error  States 
Straight  and  Level  RMS  Errors 


Values  labeled  H are  high  values  and  values  labeled  L 
are  low  values  at  data  time.  Initial  condition  values  are 
taken  from  the  total  reference  system  model. 


<5vx 

ft/sec 


6Vy 

ft/sec 


6Vz 

ft/sec 


60X 

millirad 


(50y 

millirad 


millirad 


Initial  Condition 
(t=7200  sec) 

H - 

2616. 3 

L - 

574.6 

H - 

2404.7 

L - 

537.0 

H - 

259.4 

L - 

259.4 

H - 

4.36 

L - 

2.09 

H - 

4.46 

L - 

2.45 

H - 

0.537 

L - 

0.537 

H - 

0.168 

L - 

0.165 

H - 

0.182 

L - 

0.180 

H - 

6.45 

L - 

5.61 

Decounled  17-State  Filter 


671.9 

651.5 


1395.1 

1227.5 


94.2 

92.9 


0.097 

0.107 


3.16 

3.33 


0.365 

0.364 


0.184 

0.184 


0.137 

0.138 


5.55 

5.59 


674.8 

467.3 


3006.3 

575.2 


103.6 

103.6 


1.043 

0.257 


4.58 

2.25 


0.355 

0.354 


0.160 

0.159 


5.66 

4.94 


151 


GE/EE/7^-45 


Table  XIV 


Plant  + Gyro  + Accelerometer  + Doppler  E 
Straight  and  Level  RMS  Errors 


Error  States 


Values  labeled  H are  high  values  and  values  labeled  L 
are  low  values  at  data  time.  Initial  condition  values  are 
taken  from  the  total  reference  system  model. 


Initial  Condition 
(t=7200  sec) 


Decoupled  17-State  Filter 


iHgKIII 


millirad 


millirad 


millirad 


- 2404.7 
' 537.0 


- 259.4 

- 259.4 


4.36 

2.09 


4.46 

2.45 


- 0.537 

- 0.537 


- 0.168 

- 0.165 


- 0.182 

- 0.180 


- 6.45 

5.61 


H - 778.2 

L - 743 . 0 


H - 1376.8 

L - 1214.1 


H - 94.3 

L - 93.1 


H - 0.498 

L - 0.382 


H - 3.41 

L - 3.25 


H - 0.365 

L - 0.364 


H - O.I83 

L - 0.183 


H-  0.138 
L - 0.137 


H - 5.61 


T _ c <r> 

■“  ^ j I 


- 870.3 

- 475-4 


- 2987.0 

- 574.7 


- 103.4 

- 103.4 


- 0.947 

- 0.837 


4.60 

2.29 


- 0.355 

- 0.354 


- 0.166 
~ 0.164 


5.67 

4.96 


I ; , Table  XV 

I i Plant  + Gyro  + Accelerometer  + Doppler  + Altimeter 

I Error  States  Straight  and  Level  RMS  Errors 


Values  labeled  H are  high  values  and  values  labeled  L 
are  low  values  at  data  time.  Initial  condition  values  are 
taken  from  the  total  reference  system  model. 


/arlable 

Initial  Condition 

Decoupled  17 

-State  Filter 

[units) 

(t=?200  sec) 

IQjgngjjgggjggllll 

6x 

H - 2616.3 

H - 778.2 

H - 870.3 

ft 

L - 57^.6 

L - 743.1 

L - 475.4 

6y 

H - 2404.7 

H - 1376.8 

H - 2987.2 

ft 

1 - 537.0 

L - 1214.1 

L - 574.7 

62 

H - 259.4 

H - 117.0 

H - 109.0 

ft 

L - 259.4 

L - 116.1 

L - 108.9 

6vx 

H - 4.36 

H - 0.498 

H - 0.947 

ft/sec 

‘ L - 2.09 

L - 0.382 

L - 0.838 

6Vy 

H - 4.46 

H - 3.41 

H - 4.60 

ft/sec 

L - 2.45 

L - 3.25 

L - 2.29 

6vz 

H - 0.537 

H - 0.359 

H - 0.359 

ft/sec 

L - 0.537 

L - 0.359 

L - 0.358 

6<t>K 

H - 0.168 

H - 0.183 

H - 0.166 

millirad 

L - 0.165 

L - 0.183 

L - 0.164 

60y 

H - 0.182 

H - 0.138 

H - 0.155 

millirad 

L - 0.180 

L - 0.137 

L - 0.154 

60Z 

H - 6.45 

H - 5.61 

H - 5.67 

millirad 

L - 5.61 

L - 5.57 

L - 4.96 

j 1 
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Table  XVI 

Plant  Error  States  Maneuvering  RMS  Errors 


Values  labeled  H are  high  values  and  values  labeled  L 
are  low  values  at  data  time.  Initial  condition  values  are 
taken  from  the  total  reference  system  model. 


Initial  Condition 

-State  Filter 

(units) 

(t=7200  sec) 

(t=8640  sec) 

6x 

H - 2616.3 

H “ 1680.4 

H - 2428.7 

ft 

L - 574.6 

L - 1493.7 

L - 561.6 

6y 

H - 2404.7 

H - 1692.3 

H - 2009.4 

ft 

L - 537.0 

L - 1497.8 

L - 517.4 

6z 

H - 259.4 

H - 63.8 

H - 8O3.4 

ft 

L - 259.4 

1 - 62.9 

L - 8O3.O 

<5vx 

H - 4.36 

H - 4.12 

H - 3.76 

ft /sec 

L - 2.09 

L - 3.96 

L - 1.77 

6Vy 

H - 4.46 

H - 4.41 

H - 3.37 

ft/sec 

L - 2.45 

L - 4.28 

L - 1.91 

6Vj 

H - 0.537 

H - 0.325 

H - 0.325 

ft/sec 

- 0.537 

L - 0.324 

L - 0.325 

6d>x 

H - 0.168 

H - 0.095 

H - 0.058 

millirad 

L - 0.165 

L - 0.093 

L - 0.055 

60y 

H - 0.182 

H - 0.130 

H - 0.072 

millirad 

L - 0.180 

L - 0.129 

L - 0.069 

H - 6.45 

H - 3.74 

H - 2.26 

millirad 

L - 5.61 

L - 3.71 

L - 1.99 
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Table  XVII 

Plant  + Gyro  Error  States  Maneuvering  Errors 


Values  labeled  H are  high  values  and  values  labeled  L 
are  low  values  at  data  time.  Initial  condition  values  are 
taken  from  the  total  reference  system  model. 


Initial  Condition 

Decoupled  17 

-State  Filter 

(t=7200  sec) 

(t=10,020  sec) 

6x 

H - 2616.3 

H - 1322.5 

H - 1434.8 

ft 

L - 57^.6 

L - 1201.9 

L - 507.4 

6y 

H - 2404.7 

H - 1497.6 

H - 1626.5 

ft 

L - 537.0 

L - 1341.1 

L - 509.6 

6z 

H - 259.4 

H - 63.8 

H - 80.2 

ft 

L - 259,4 

L - 62.1 

L - 80,2 

X 

> 

K5 

H - 4.36 

H - 2.93 

H - 3.17 

ft/sec 

L - 2.09 

L - 2.88 

L - 1.98 

6Vy 

H - 4.46 

H - 4.07 

H - 3.59 

ft/sec 

L - 2.45 

L - 3.98 

L > 2.27 

< 

N 

H - 0.537 

H - 0.324 

H - 0.325 

ft/sec 

L - C.537 

L - 0.324 

L - 0.324 

(50X 

H - 0 . 1 68 

H - 0.059 

H - 0.067 

millirad 

L - 0.165 

L - 0.057 

L - 0.065 

60y 

H - 0.182 

H - 0.056 

H - 0.091 

millirad 

L - 0.180 

L - 0.053 

L - 0.090 

602 

H - 6.45 

H - 4.91 

H - 4.40 

millirad 

L - 5.61 

L - 4.89 

L - 3.88 
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Table  XVIII 

Plant  + Gyro  + Accelerometer  Error  States 
Maneuvering  RMS  Errors 


1 

, I 


Values  labeled  H are  high  values  and  values  labeled  L 
are  low  values  at  data  time.  Initial  condition  values  are 
taken  from  the  total  reference  system  model. 


Initial  Condition 
(t=7200  sec) 


6x 

H - 2616.: 

ft 

L - 574. 

<5y 

H - 24o4. 

ft 

L - 537. 

(5z 

H - 259. 

ft 

L - 259. 

millirad 


60y 

millirad 


6<t>z 

millirad 


K - 4.36 

L - 2.09 


H - 4.46 

L - 2.45 


H - 0.537 

L - 0.537 


H - 0.168 

L - 0.165 


H - 0.182 

L - 0.180 


H - 6.45 

L - 5.61 


Decoupled  17-State  Filter 


1120.7 

1027.8 


H - 1227.5 

H - 1581. 2 

L ~ 1112.0 

L - 502.7 

H - 95.0 

H - 103.1 

L - 93.7 

L - 103.1 

H - 2.67 

H - 2.77 

L - 2.60 

L - 1 . 61 

H - 3.68 

H - 3.32 

L - 3.59 

L - 2.06 

H - 0.365 

H - 0.352 

L - 0.364 

L - 0.352 

H - 0.159 

H - 0.156 

L - 0.158 

L - 0.155 

H - 0.158 

H - 0.166 

L - 0.157 

L - 0.166 

H - 4.88 

H - 4.28 

L - 4.86 

L - 3.73 
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Table  XIX 

Plant  + Gyro  + Accelerometer  + Doppler  Error  States 
Maneuvering  RMS  Errors 


i Values  labeled  H are  high  values  and  values  labeled  L 

atre  low  values  at  data  time.  Initial  condition  values  are 
taken  from  the  total  reference  system  model. 


i/^ariable 

Initial  Condition 

Decoupled  17 

-State  Filter  I 

(units) 

(t=7200  sec) 

6x 

H - 

2616.3 

H 

- 1181.4 

H - 

1482.4  1 

ft 

L - 

57^.6 

L 

- 1078.7 

L - 

505.2 

6y 

H - 

2404.7 

H 

- 1245.9 

H - 

1593.8 

ft 

L - 

537.0 

L 

- 1127.0 

L - 

503.6 

6z 

H - 

259.4 

H 

- 95.0 

H - 

103.1 

ft 

L - 

259.4 

L 

- 93.7 

L - 

103.1 

<5vx 

H - 

4.36 

H 

- 2.77 

H - 

2.89 

ft/sec 

L - 

2.09 

D 

2.69 

L - 

1.65 

6Vy 

H - 

4.46 

H 

- 3.69 

H - 

3.33 

ft/sec 

L - 

2,45 

L 

- 3.60 

L - 

2.05 

H - 

0.537 

H 

- 0.365 

H - 

0.353 

ft/sec 

L - 

0.537 

L 

- 0.364 

L - 

0.352 

<50x 

H - 

0.168 

H 

- 0.159 

H - 

0.156 

millirad 

L - 

0.165 

L 

- 0.159 

L - 

0.155 

6<t>y 

H - 

0.182 

H 

- 0.158 

H - 

0.167 

millirad 

L - 

0.180 

L 

- 0.158 

L - 

O.I67 

(502 

H - 

6.45 

H 

4.90 

H - 

4.29 

millirad 

L - 

5.61 

L 

4.88 

L - 

3.78 
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Table  XX 

Plant  + Gyro  + Accelerometer  + Doppler  + Altimeter 
Error  States  Maneuvering  RMS  Errors 


Values  labeled  H are  high  values  and  values  labeled  L 
are  low  values  at  data  time.  Initial  condition  values  are 
taken  from  the  total  reference  system  model. 


/ariable 

Initial  Condition 

Decoupled  17 

-State  Filter 

(units) 

(t=7200  sec) 

(t=8640  sec) 

(t=10,020  secT 

6x 

H - 

2616.3 

H - 1181.4 

H - 

1482.4 

ft 

L - 

57^.6 

L - 1078.7 

L - 

505.2 

6y 

H - 

2404.7 

H - 1245.9 

H - 

1593.8 

ft 

L - 

537.0 

L - 1127.0 

L - 

503.6 

6z 

H - 

259.4 

H - 117.5 

H - 

108.7 

ft 

L - 

259.4 

L - 116.6 

L - 

108.5 

(5vx 

H - 

4.36 

H - 2.77 

H - 

2.89 

ft/sec 

L - 

2.09 

L - 2.69 

L - 

1.65 

6Vy 

H - 

4.46 

H - 3.69 

H - 

3.33 

ft/sec 

L - 

2.45 

L - 3.60 

1 - 

2.05 

6v/z 

H ~ 

0.537 

H - 0.359 

H - 

0.357 

ft/sec 

L - 

0.537 

L - 0.359 

L - 

0.356 

6<^x 

H - 

0.168 

H - 0.159 

H - 

0.156 

millirad 

L - 

0.165 

L - 0.159 

L - 

0.155 

6<t>y 

H - 

0.182 

H - 0.158 

H - 

0.I67 

millirad 

L - 

0.180 

L - 0.158 

L - 

0.167 

Ch 

N 

H - 

6.45 

H - 4,90 

H - 

4.29 

millirad 

L - 

5.61 

L - 4.88 

T 

AJ  ” 

3.78 
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the  plots  for  each  of  the  nine  basic  plant  error  states  as 
the  coaiplexity  of  the  system  reference  model  is  increased  to 
include  the  gyro  errors,  accelerometer  errors,  Doppler 
errors,  and  the  altimeter  error.  Tables  XI  through  XV  give 
the  data  for  straight  and  level  flight  while  Tables  XVI 
through  XX  pertain  to  the  maneuvering  flight  profile.  The 
high  values  on  the  initial  conditions  are  given  only  as  a 
reference  to  aid  in  visualizing  the  trend  of  the  average 
values  between  the  high  and  low  data  points.  This  means  that 
an  indication  of  the  general  shape  of  the  plots  can  be 
obtained  by  connecting  the  average  values  at  each  data  point 
listed.  An  example  of  this  technique  is  shown  in  Figure  70 
below. 


Tables  XXI  and  XXII  snow  the  error  budget  for  straight 
and  level  end  maneuvering  flight  respectively.  The  error 
budget  is  showri  as  i;he  percentage  contribution  to  the  total 
error  for  each  system  reference  model  configuration.  An 
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increase  in  the  error  is  shown  as  a positive  percentage  and 
a reduction  in  the  error  is  shown  as  a negative  percentage. 
For  example , referring  to  Table  XXI , the  plant  model  alone 
contributes  136.33?^  of  the  high  value  of  position  error  based 
on  a complete  system  reference  model  error  of  87O.3  feet  at 
10,020  seconds.  By  adding  the  gyro  models  the  error  is 
reduced  -45.7^  and  audition  of  the  accelerometer  models 
reduces  to  error  another  13. 05?^.  When  the  Doppler  model  is 
added  the  error  is  increased  by  22.4^  and  the  altimeter 
model  has  negligible  affect  on  the  x position  error.  The 
total  X position  error  is  then  1005^  of  the  870.3  feet  used 
as  a base  value. 

These  tables  show  no  real  consistency  in  the  error 
contributions  between  the  straight  and  level  case  and 
maneuvering  case  with  one  exception.  The  Doppler  generally 
contributes  a larger  portion  of  the  total  error  during 
maneuvering  flight  than  it  does  in  straight  and  level  flight. 
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VII . Conclusions  and  Recommendations 

Conclusions 

Based  on  the  material  presented  in  this  thesis,  as  well 
as  knowledge  gained  throughout  the  study,  the  following 
conclusions  are  drawn: 

1.  The  decoupled  17-state  filter  provides  adequate 
performance  during  straight  and  level  flight  over  land  but 
allows  the  x and  y velocity  and  the  heading  errors  to  reach 
values  approximately  twice  those  of  the  optimal  filter. 

2.  Although  level  channel  velocity  errors  increase 
about  twofold  during  a maneuvering  flight  profile,  the 
decoupled  17-state  filter  performance  is  not  significantly 
degraded  in  this  environment. 

3.  The  separate  contributions  of  the  various  error 
sources  to  the  total  error  budget  cannot  be  readily  determined 
as  a function  of  the  flight  environment.  However,  the  Doppler 
error  contribution  appears  to  be  greater  during  maneuvering 
flight . 

k.  Finally,  it  should  be  emphasized  again  that  this 
type  of  covariance  analysis  is  very  sensitive  to  (a)  the 
initial  conditions  of  the  covariance  matrix,  P(0),  (b) 
erroneous  system  reference  models,  and  (c)  the  dynamics  of 
the  flight  profile. 

Recommendations 

The  following  recommentdations  are  made  for  continued 


163 


GE/EE/74-i4-5 


study  in  the  subject  area  of  this  thesis  and  for  improvement 
in  the  existing  computer  programs: 

1.  A terrain  following  flight  profile  should  be 
investigated  with  the  associated  variations  in  g loading. 

2.  Filter  performance  should  be  investigated  during 
partial  siding  system  failures  such  as  Doppler  and/or  position 
fix  radar  inoperative. 

3.  The  filter  effectiveness  should  be  tested  for  various 
values  of  Q matrix  and  R matrix  noises.  This  is  especially 
necessary  with  the  trend  toward  underestimation  of  certain 
errors  after  1#  hours  of  flight,  indicating  that  some  Q terms 
are  too  small,  and  that  the  proposed  design  used  a large  P(0) 
rather  than  an  increased  Q to  tune  the  filter.  Longer  flight 
times  will  demonstrate  the  proper  tuning  values, 

4.  Another  area  of  interest  would  be  the  effect  of 
staggered  measurement  updates  rather  than  regular  intervals. 
This  would  more  closely  approach  an  actual  flight  environment. 
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